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1.0  INTRODUCTION  AND  SUMMARY 


1.1  Background 

The  purpose  of  this  thesis  is  to  investigate  the  applicability  of 
designing  a  multivariable  controller  for  a  deeply  submerged  underwater 
vehicle  using  the  Linear  Quadratic  Guassian  (LQG)  with  Loop  Transfer 
Recovery  (LTR)  methodology.  At  the  present  time,  there  are  few  examples 
of  multi-input,  multi-output  (MIMO)  design  of  complex  systems  using  the 
LQG  procedure  and  still  fewer  examples  which  actually  test  the  control 
system  on  a  nonlinear  simulation  as  will  be  accomplished  in  this  thesis. 

While  it  is  possible  that  full  state  feedback  could  be  achieved  in 
the  present  system,  this  is  not  always  practical  or  feasible  in  general 
for  systems  with  inaccessible  state  variables.  Moreover,  being  able  to 
accomplish  control  with  only  a  selected  set  of  the  available  state 
variables  provides  additional  flexibility  and  efficiency  in  designing  a 
fault-tolerant  system. 

As  one  of  the  primary  concerns  of  submerged  vehicle  operations  is 
course  and  depth  keeping,  it  is  natural  to  desire  to  control  the  heading 
angle  (psi,  i|>)  and  depth  (z)  of  the  vehicle.  Thus,  for  thi3  design  it 
is  intended  to  feedback  only  two  states  (psi  and  z)  and  obtain 
reconstruction  of  the  remainder  as  a  by-product  of  a  Kalman  filter-based 
estimator  within  the  compensator  structure. 

There  are  several  reasons  for  designing  a  depth  and  heading 
controller.  An  automatic  control  system  can  be  expected  to  reduce  the 
operational  workload  and  thus  the  required  manning,  with  manual 
control,  the  response  to  course  and  depth  changes  tends  to  be 
oscillatory,  especially  at  higher  speeds.  Automatic  control  should 
provide  control  surface  movement  which  is  more  precise,  requiring  less 
overall  motion  and  energy.  The  reduction  in  lifting  surface  motion  will 
also  lower  vehicle  resistance  and  reduce  fuel  costs. 
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It  is  emphasized  that  the  type  of  controller  design  proposed  here 
would  be  utilized  under  normal  operating  conditions  such  as  transits 
from  one  location  to  another  or  in  patrolling  a  given  area  of  the 
ocean.  It  is  not  intended  that  the  control  system  be  used  for  rapid 
maneuvers  such  as  collision  avoidance  or  navigation  in  restricted 
waters. 

1 .2  Contributions  of  the  Thesis 

The  primary  contribution  of  this  thesis  is  the  design  of  a  truly 
multivariable  control  system  for  a  submerged,  underwater  vehicle. 
Typically,  such  vehicles  have  been  controlled  by  separating  plans  of 
motion  and  coordinating  the  decoupled  control  actions.  However,  when 
cross-coupling  is  considerable,  the  control  system  thus  designed  may 
actually  become  unstable. 

Design  of  a  truly  multivariable  controller  overcomes  the 
shortcomings  of  some  of  the  "classical"  designs.  The  coupling  between 
planes  of  motion,  as  discussed  in  Chapter  2,  is  particularly  severe  for 
the  system  under  consideration.  With  multivariable  control,  these 
coupling  effects  are  incorporated  in  the  design  and  thus,  one  may  expect 
to  develop  good  controllers  in  a  more  systematic  fashion. 

An  additional  contribution  of  this  thesis  is  that  it  represents  the 
first  attempt  to  apply  the  LQG/LTR  control  methodology  to  design  an 
autopilot  for  a  submersible.  This  methodology,  which  largely  follows 
the  work  of  Doyle  and  Stein  [5],  has  several  excellent  characteristics. 
First,  it  is  a  systematic  procedure  which,  through  the  use  of  singular 
values,  allows  one  to  "design  to"  a  set  of  frequency-domain 
specifications.  With  appropriately  chosen  design  specifications,  the 
compensated  system  will  exhibit  desirable  command  following  and 
disturbance  rejection  properties  as  well  as  insensitivity  to  modeling 
errors  and  sensor  noise.  Further,  the  design  methodology  allows  one  to 
ascertain  the  multivariable  robustness  properties  (stability  margins), 
ensuring  closed-loop  stability  in  the  presence  of  modeling  errors. 


Finally,  the  control  design  is  tested  on  a  nonlinear  simulation. 

Due  to  the  inherent  robustness  properties  of  the  LQG  method,  we  may 
expect  the  controller  to  operate  satisfactorily  at  other  than  its 
nominal  speed  and  position  in  state  space.  This  will  ease  the  gain 
scheduling  task. 

1.3  Outline  of  the  Thesis 

Chapter  2  contains  a  physical  description  of  the  submarine  with  its 
nonlinear  and  linearized  equations  of  motion.  The  second  part  of  the 
chapter  investigates  the  dynamics  of  the  linear  model  obtained  at  twenty 
knots.  This  includes  a  modal  analysis  and  the  open  loop  singular  values 
of  the  plane. 

Chapter  3  discusses  the  desirable  characteristics  of  the  controller 
and  sets  some  specifications  to  be  met  in  the  frequency  and  time 
domains.  Multivariable  robustness  considerations  are  also  discussed. 

Chapter  4  presents  the  model-based  compensator  structure  along  with 
a  discussion  of  the  augmented  dynamics  incorporated  in  this  design.  The 
LQG/LTR  controller  design  methodology  is  shown  and  a  control  design 
based  on  the  twenty  knot  linear  model  is  developed.  Finally,  the 
compensator  is  tested  on  the  linear  and  nonlinear  simulations. 

Chapter  5  investigates  the  speed  range  over  which  the  compensator, 
designed  using  the  twenty  knot  linear  model,  meets  the  specifications 
and  presents  the  other  models  (linearized  for  different  speeds) 
necessary  to  accomplish  automatic  control  over  the  speed  range  of  the 
submarine. 

Finally,  Chapter  6  contains  the  conclusions  and  recommendations  for 
future  study. 
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2.0  SYSTEM  DESCRIPTION.  MODELING  AND  ANALYSIS 


2.1  Introduction 

In  this  chapter  we  shall  first  discuss  the  submarine  in  physical 
terms,  describing  its  salient  features  and  dynamic  characteristics. 

Some  background  will  be  given  in  the  sequel  describing  the  nonlinear 
equations  of  motion  after  which  a  short  derivation  of  the  linearized 
dynamics  is  presented  along  with  the  state  variables  and  system  inputs 
and  outputs.  The  twenty-knot  linear  model  is  then  presented  and 
verified  by  comparing  the  linear  and  nonlinear  dynamic  responses. 
Finally,  an  analysis  of  the  dynamics  of  tne  linear  model  is  undertaken 
including  the  pole/zero  structure  and  a  modal  analysis. 

2.2  System  Description 

The  system  to  be  controlled  is  a  manned,  underwater  vehicle  with 
port/starboard  (left/right)  symmetry  as  shown  in  Figure  2.1.  For  the 
purpose  of  this  control  design  the  vehicle  is  assumed  to  be  well  below 
the  surface  of  the  ocean  and  its  mass  constant.  Neutral  buoyancy  is 
assumed  as  the  ballast  system  is  not  modeled.  The  control  surface 
configuration  consists  of  a  cruciform  stern  with  separate  sternplanes 
and  rudder  located  aft  and  fairwater  planes  located  on  the  sail.  There 
is  no  differential  control;  that  is,  both  the  upper  and  lower  or  port 
and  starboard  control  surfaces  must  rotate  together. 

Positive  rudder  deflections  primarily  cause  the  vehicle  to  turn 
left;  however,  due  to  vehicle  banking  (which  causes  the  rudder  to  act  to 
some  degree  as  a  sternplane)  as  well  as  crossflow  drag  effects  and 
lifting  surface  memory  effects  the  vehicle  exhibits  a  tendency  to  dive 
in  a  turn.  Further,  the  stern  and  fairwater  plans  will  tend  to  be 
"seen”,  to  a  certain  extent,  as  rudders.  These  effects  are  quite 
pronounced  at  higher  speeds.  Thus,  there  is  considerable  cross-coupling 
between  planes  of  motion. 
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Figure  2.1.  Sketch  showing  positive  directions  of  axes,  angles, 
velocities,  forces,  and  moments. 
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While  the  generic  model  of  the  underwater  vehicle  is  based  on  the 
the  original  Naval  Ship  Research  and  Development  Center  (NSRDC)  2510 
Report  [8],  various  supplemental  models  have  subsequently  evolved. 

These  modifications  enable  the  model  to  predict  well  at  least  one 
particular  aspect  of  vehicle  motion.  The  most  notable  additions  attempt 
to  model  the  memory  effects  of  velocities  induced  on  the  afterbody  and 
control  surfaces  by  trailing  vortices  from  the  fairwater  planes  and 
sail.  Thus,  the  effects  of  crossflow  drag  and  vortex  shedding  have  been 
included  in  the  math  model)  however,  neither  surface  or  bottom  effects 
are  included. 

Finally,  the  subject  vehicle  is  capable  of  speeds  in  excess  of 
thirty  knots  with  a  minimum  speed  of  about  five  knots.  The  sternplanes 
and  rudder  are  limited  to  a  maximum  of  plus  or  minus  forty  degrees  of 
rotation  with  the  fairwater  planes'  maximum  excursion  limited  to  twenty 
degrees. 

2.3  Vehicle  Modeling 
2.3.1  Nonlinear  Equations  of  Motion 

The  system  dynamics,  including  control  forces  and  moments  exerted 
by  the  rudder  and  planes,  are  typically  described  by  a  set  of  six  degree 
of  freedom  nonlinear  differential  equations  based  on  the  NSRDC  2510 
report  [8] .  The  equations  are  general  enough  to  simulate  the  rigid  body 
trajectories  and  responses  of  a  submarine  in  normal  maneuvers  as  well  as 
in  extreme  maneuvers  such  as  those  associated  with  emergency  recoveries 
from  a  sternplane  jam  and  flooding  casualties.  Over  the  years 
correlation  to  full  scale  trial  measurements  with  the  following 
equations  has  shown  them  to  yield  accurate  predictions  of  submarine 
motions  and  trajectories.  The  advantage  of  using  this  formulation  is 
that  it  is  experimentally  based  and  takes  advantage  of  commonly  used 
experimental  techniques  in  generating  many  of  the  hydrodynamic 
coefficients. 


The  hydrodynamic  coefficients  constitute  the  heart  of  the 
mathematical  model  used  to  simulate  the  rigid-body  motions  of  the 
vehicle.  The  hydrodynamic  coefficients  used  for  this  study  are  for  a 
deeply  submerged  vehicle,  free  of  free-surface,  bottom,  and  wall 
effects.  The  hydrodynamic  forces  and  moments  which  enter  into  the 
equations  as  coefficients  are  usually  classified  into  three  categories: 
static,  rotational,  and  acceleration.  The  static  coefficients  are  from 
the  linear  velocity  components  of  the  vehicle  relative  to  the  fluid,  the 
rotary  coefficients  are  due  to  angular  velocity  components  and  the 
acceleration  coefficients  are  due  to  either  linear  or  angular 
accelerations.  Within  limited  ranges,  the  coefficients  are  linear  with 
respect  to  the  appropriate  variables,  and  thus  yield  good  results  in  the 
linearized  equations  of  motion  [8]. 

The  major  modeling  problem  therefore  reduces  to  finding  the 
numerical  values  of  the  individual  coefficients  with  sufficient  accuracy 
to  support  the  objective  of  the  simulation  study,  in  this  case  an 
automatic  heading  and  depth  controller  to  be  used  during  normal  underway 
operations.  Ideally,  one  would  acquire  the  values  for  a  given  vehicle 
configuration  using  hydrodynamic  theory.  Unfortunately,  those 
coefficients  which  are  due  primarily  to  viscous  flow  considerations, 
such  as  the  static  and  rotary  coefficients,  cannot  be  obtained  reliably 
using  existing  theory  alone.  Theory  has  been  used  with  good  results  in 
computing  the  acceleration  coefficients  for  simple  shapes  without 
appendages,  using  potential  flow  theory.  For  an  actual  underwater 
vehicle  which  includes  appendages  such  as  control  surfaces,  propellers 
and  bridge  fairwaters,  the  use  of  theory  does  not,  in  most  cases,  yield 
results  which  accurately  describe  the  physical  system.  Accordingly,  the 
present  state  of  the  art  is  either  to  rely  on  experimental  means  or 
semi -empirical  computer-based  methods  to  determine  the  hydrodynamic 
coefficients  for  a  specific  design. 

The  primary  experimental  method  used  to  obtain  the  coefficients  is 
the  planar-motions-mechanisms-system  in  conjunction  with  a  physical 
model  of  the  vehicle.  The  physical  models  used  for  testing  are  large  as 
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towing  tank.  This  permits  determination  of  the  hydrodynamic 
coefficients  which  are  comparatively  free  of  scale  effects  and  other 
experimental  problems.  Using  a  large  model  allows  one  to  obtain,  more 
easily,  the  high  Reynolds  number  necessary  to  avoid  the  effects  of 
transitional  flow  over  the  hull  and  appendages  of  the  model,  the 
planar-motions-mechanism  is  used  to  find  all  the  values  of  hydrodynamic 
coefficients  except  certain  coupling  terms  and  those  nonlinearities 
associated  with  high  values  of  angular  velocity,  found  while  conducting 
tight  turns  or  dives  [1,8].  If  such  values  are  required,  the  planar- 
motions-mechanism  tests  are  supplemented  by  the  rotating-arm  test.  The 
hydrodynamic  coefficients  used  in  this  study  were  provided  by  NSRDC  for 
a  generic  underwater  vehicle. 

The  equations  of  motion  are  written  in  a  right-hand  orthogonal 
system  of  moving  axes,  fixed  in  the  body,  with  its  origin  located  at  the 
center  of  gravity  of  the  vehicle.  The  axes  are  body  fixed  as  the 
hydrodynamic  forces  and  inertia  are  most  readily  computed  in  the 
vehicle's  frame.  As  shown  in  Figure  2.1,  the  xy  plane  is  the  principal 
plane  of  symmetry,  with  the  x-axis  parallel  to  the  baseline  of  the 
body.  The  positive  direction  of  the  axes  are  as  follow:  x-forward, 
y-s tar board,  and  z -downward .  The  remaining  sign  conventions  follow  from 
the  right-hand  rule.  The  positive  directions  of  the  axes,  angles, 
linear  and  angular  velocity  components,  forces  and  moments  are  also 
show  in  Figure  2.1.  For  the  purposes  of  control,  it  is  sufficient  to 
include  the  effect  of  relative  motion  between  the  body  frame  and  flat 
non-rotating  earth  frame  with  the  latter  used  as  the  inertial  frame. 

Thus  the  effects  of  the  earth's  rotation  and  its  spherical  shape  have 
been  neglected  as  they  are  relatively  small.  The  nonlinear  equations, 
and  kinematic  relations,  are  given  in  Appendix  A,  and  include  the 
crossflow  drag  and  lifting  surface  memory  effects .  The  definitions  of 
the  hydrodynamic  coef fiocients  are  contained  in  reference  [8]. 


2.3.2  Linear  Time  Invariant  State  Space  Model 

For  the  purposes  of  controller  design  the  nonlinear  equations  of 
notion  are  linearized  about  an  operating  or  nominal  point.  Further,  it 
is  sought  to  place  the  linearized  equations  in  a  state  space  form  as 
shorn  below: 

MX  -  Ax  +  Bu  (2.1 ) 

where  x  is  the  state  variable  vector  and  u  is  the  control  vector. 

The  equations  are  therefore  expanded  in  a  Taylor  Series  about  the 
steady-state  operating  point  with  only  the  first  order  terms  of  the 
expansion  being  retained.  Thus,  given  the  nonlinear  state  model  of  the 
form: 


Mx  -  f(x,u)  (2.2) 

we  linearize  about  the  nominal  point  xQ,  Ug.  Neglecting  higher 
order  terms  we  find  the  linearized  dynamics  to  be  described  by  the 
following  equations 

.  ..  ..  .  5f(x  ,u  ),  ,  5f(x  ,u  ),  .  . _  ,, 

MX  +  H  Ax  •  f(x  ,u  )  +  —o—o  (x-x  )  +  -o-o  (u-u  ).  (2.3) 

— ~o  —  — - o  — o  .  —  — o  - o 

6x_ 

The  nominal  input  Up  and  the  resulting  nominal  state  x0  satisfy 

the  original  equations  of  motion  at  the  nominal  point,  M&-f (xn,u0) . 
Defining  Ax  ■  (x  -  Xg)  and  Au  ■  (u  -  Up) ,  one  has 

MA*  -  «£(W  Ax  +  «£(5o'V  Au  (2.4) 

&x  6u 

which  is  of  the  desired  form,  where  A  -  — and  b  » 

5x  5u 
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The  linearized  equations  of  motion  can  be  found  in  Appendix  B. 

2.3.3  State  Variables 

The  six  equations  for  surge,  sway,  heave,  roll,  pitch  and  yaw 
contain  eight  variables  in  addition  to  the  hydrodymanic  coefficients. 
These  are  u  (forward  speed),  v,  w,  p,  q,  r,  $  and  6.  To  the  previous 
six  equations  we  add  the  four  kinematic  relations  -  depth  rate  (2),  roll 
rate  ($),  pitch  rate  (9),  and  yaw  rate  (i|>).  As  it  is  intended  to 
control  the  yaw/heading  angle  and  depth  these  variables  will  be 
considered  as  the  feedback  state  variables  for  this  design.  It  is 
interesting  to  note  that  none  of  the  ten  state  equations  used  to  model 
the  system  is  a  function  of  the  heading  angle  or  depth.  Thus,  the 
system  as  presently  modeled  has  two  integrators  associated  with  the 
variables  psi  and  z.  Within  linear  system  theory,  this  integrator 
action  shall  ensure  no  steady  state  error  for  step  disturbances  in  the 
closed-loop  compensated  system. 

2.3.4  Outputs  and  Control  Inputs 

The  intent  of  this  thesis  is  to  use  and  evaluate  the  loop  transfer 
recovery  technique  (discussed  in  Chapter  4)  to  design  the  compensator. 
This  methodology  requires  a  square  system  with  an  equal  mm  bar  of 
control  inputs,  u,  and  observed  outputs,  y.  As  the  compensator  to  be 
designed  is  to  control  the  heading  angle  and  depth;  and,  since  these 
variables  are  readily  available  for  measurement,  they  are  selected  as 
the  system  outputs.  Thus,  the  output  vector  is: 


The  choice  of  two  control  inputs  is  only  slightly  more  difficult. 
The  vehicle  has  available,  as  inputs,  its  three  control  surfaces  -  the 
rudder,  stern  and  fairwater  planes.  As  the  fairwater  and  sternplanes 
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are  redundant  (either  can  separately  control  depth,  depth  rate  or  pitch) 
and  present  operating  procedure  is  to  fix  the  fairwater  planes  while 
utilizing  the  sternplanes;  the  system  inputs  selected  were  the  rudder 
and  stemplane  deflection  (fir,  5s),  The  input  vector  is  then: 


(2.6) 


Note  that  by  not  utilizing  the  fairwater  planes  under  normal  conditions, 
a  separate  set  of  gains  can,  in  the  future,  be  generated  as  a  means  of 
back-up  depth  control.  Table  2.1  lists  the  inputs,  states  and  outputs 
of  the  submarine  used  in  this  control  design  along  with  their  respective 
units. 


2.3.5  Twenty  Knot  Linear  Model 

The  function  of  the  multivariable  controller  to  be  designed  is  to 
maintain  an  ordered  course  and  depth  as  well  as  to  be  capable  of 
altering  vehicle  heading  and  depth.  As  the  submarine  will  spend  the 
great  majority  of  time  maintaining  a  given  course  and  depth,  it  was 
decided  to  linearize  about  straight  ahead  motion  at  constant  speed,  The 
SUBMODEL  program,  developed  at  Draper  Laboratory  is  briefly  discussed  in 
Appendix  C  and,  more  completely,  in  reference  [18].  It  was  used  to  find 
the  local  equilibrium  point. 

The  local  equilibrium  point  was  found  by  perturbing  u,  v,  w,  p,  q, 
r,  0,  and  0  until  the  accelerations  (derivations  of  the  states)  were, 
practically  speaking,  zero.  The  accelerations  and  equilibrium  values  of 
the  states  at  twenty  knots  are  listed  in  Table  C.l  of  Appendix  C. 

At  this  point,  the  linear  dynamics  are  calculated  and  the  ten  by 
ten  K-1  A  (Ap)  and  the  ten  by  three  M^B  (Bp)  matrices  generated. 

The  Ap,  Bp,  and  Cp  matrices  are  shown  in  Table  C.3  of  Appendix  C 
and  represent  the  unaugmented  submarine  model  at  twenty  knots.  The  Bp 
matrix  still  shows  three  controls  as  the  fairwater  planes  have  not  yet 
been  'locked”.  Subsequently,  in  the  control  design,  the  second  column 

of  Bp  (corresponding  to  the  fairwater  planes),  is  deleted. 
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TABLE  2.1 


Vehicle  Control  Inputs 
sternplane  deflection  -  degrees 
rudder  deflection  -  degrees 

States 

u,  forward  speed  -  ft/sec 

v,  lateral  speed  -  ft/sec 

w,  vertical  speed  -  ft/sec 

p,  roll  rate  -  radians/sec 

q,  pitch  rate  -  radians/sec 

r,  yaw  rate  -  radians/sec 
♦  ,  roll  angle  -  degrees 
0 ,  pitch  angle  -  degrees 

yaw/heading  angle  -  degrees 
■  z,  depth  -  feet 

System  Outputs 
<|>,  yaw  angle  -  degrees 
z,  depth  -  feet 


2.3.6  Model  Verification 

To  ascertain  the  validity  of  the  linear  model  about  a  particular 
nominal  point,  one  only  has  to  equally  perturb  the  linear  and  nonlinear 
models  (using  the  SUBMODEL  program),  then  observe  and  compare  their 
responses.  If  the  linear  model  dynamics  are  sufficiently  close  to  the 
nonlinear  response,  one  may  have  confidence  in  the  linear  model. 
Additionally,  one  can  gain  a  feeling  for  the  region  of  state  space  in 
which  the  linear  model  is  valid  by  comparing  the  linear  and  nonlinear 
responses  for  various  perturbations  from  the  nominal  point. 

As  an  example,  the  linear  and  nonlinear  responses  with  no  control 
surface  deflection  and  initial  perturbations  in  q  and  r  of  0.01 
radians/second  are  shown  in  the  plots  in  Figure  2.2.  Note  with  the 
exception  of  the  forward  speed,  u,  the  close  agreement  of  responses. 

The  difference  in  forward  speed  can  be  attributed  to  the  fact  that  we 
linearized  about  straight  ahead  motion  at  constant  speed  [1].  Other 
tests  with  different  states  perturbed  were  made  with  the  comparisons 
between  linear  and  nonlinear  responses  being,  in  general,  excellent. 
Since  the  controller  is  to  be  capable  of  turning  and  diving,  non-zero 
settings  of  the  rudder  and  sternplanes  were  also  compared. 

Comparing  the  linear  and  nonlinear  responses  with  the  sternplanes 
set  at  two  degrees,  there  is  generally  good  agreement,  especially  if  one 
compares  not  only  the  shapes  but  the  absolute  values.  Of  particular 
interest  are  the  psi  and  depth  responses  shown  in  Figure  2.3.  The 
nonlinear  and  linear  values  at  100  seconds  for  psi  although  opposite  in 
direction  are  both  essentially  zero  (.0045  versus  -.0013  degrees).  The 
depth  response  for  the  linear  model  follows  very  closely  for  the  first 
thirty  seconds  (within  one  foot).  The  depth  at  100  seconds  being  633 
feet  for  the  linear  model  and  574  feet  in  the  nonlinear  case.  The 
variations  between  the  responses  is  certainly  acceptable. 

When  one  compares  the  linear  and  nonlinear  heading  and  depth 
responses  with  a  two-degree  rudder  deflection  (Figure  2.4)  the  major 
weakness  of  linearizing  about  straight  ahead  motion  becomes  apparent. 

Hie  linear  model  shows  nearly  no  deviation  in  depth  during  a  turn  (-.16 


Figure  2.2:  Linear  Nodal  Reaponae  at  Twenty 

Knot a,  q*r«.01  radiana  par  aecond 
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Figure  2.2:  Nonlinear  Model  Response  at  Twenty 
Knots*  q*r*.01  radians  per  second 
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Figure  2.3:  Linear  end  Nonlinear  Reeponaee  at 
Twenty  Knota  with  a  Sternplane 
Deflection  of  2  Degreea 
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feet)  while  the  nonlinear  model  (due  to  the  cross-coupling  effects) 
shows  a  depth  excursion  of  47  feet  at  100  seconds.  However,  it  should 
be  noted  that  the  difference  between  the  two  models  is  less  than  a  foot 
at  times  less  than  30  seconds. 

The  psi  responses  compare  well,  with  the  difference  between  the 
linear  and  nonlinear  heading  being  less  than  1.5  degrees  at  30  seconds. 
At  100  seconds,  the  nonlinear  model  has  shown  a  heading  change  of  -60 
degrees  while  the  linear  model  is  at  -103  degrees. 

Other  comparisons  with  different  control  surface  deflections  and 
vehicle  speeds  show  the  same  general  results.  As  expected,  the  linear 
and  nonlinear  model  responses  increasingly  deviate  as  the  deflections 
and  speeds  increased,  however  there  was  good  agreement  in  the  first  20 
to  30  seconds.  These  analyses  suggest  that,  if  the  control  design  which 
is  based  on  the  linear  model  of  the  submarine,  requires  large,  prolonged 
control  surface  deflections,  the  compensator  may  not  provide  adequate 
response  to  perturbations.  This  is  so  because  the  controller  will  have 
based  its  actions  on  the  expected  linear  response  while  the  actual 
vehicle  more  closely  follows  the  nonlinear  model. 

2.4  Model  Dynamics 

2.4.1  Analysis  of  the  Twenty  Knot  Linear  Model 

In  this  section,  the  submarine  dynamics  shall  be  investigated.  The 
multivariable  poles  and  zeros  are  presented  and  their  implications 
discussed.  A  modal  analysis  is  conducted  to  further  validate  the  linear 
model  and  lead  to  a  more  complete  understanding  of  the  vehicle 
dynamics.  Controllability  and  observability  studies  are  undertaken  and 
the  plant  open-loop  singular  values  are  calculated  and  their 
implications  in  future  controller  design  discussed. 

2.4.2  Pole  Structure 

The  stability  of  the  system  depends  solely  on  its  poles  (the 
eigenvalues  of  Ap).  For  stability  all  eigenvalues  must  have  negative 
real  parts.  Stability  implies  that,  if  the  vehicle  is  perturbed  from 
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its  equilibrium  point  in  state  space,  it  will  naturally  tend  to  return 
to  its  nominal  state.  The  poles  of  the  system  are  shown  in  Table  2.2. 

Mote  the  two  poles  at  zero  due  to  the  independence  of  all  the  equa¬ 
tions  to  the  state  variables  psi  and  z.  These  poles  at  the  origin  show 
that  there  is  no  tendency  for  the  vehicle  to  return  to  a  given  heading 
or  depth  (assuming  that  we  have  that  weight  equals  buoyancy)  when  per¬ 
turbed.  Further  note  that  the  fastest  system  pole  is  -0.33  radians  per 
second.  This  emphasizes  the  fact  that  the  submarine  is  a  very  slow  sys¬ 
tem.  Also,  the  two  sets  of  complex  conjugate  pairs  correspond  to  the 
oscillatory  roll  and  pitch  modes.  It  is  desirable  to  further  associate 
the  poles  with  the  states  and  modes  in  order  that  one  may  gain  insight 
into  the  physical  system  and  also  further  verify  the  linear  model.  To 
accomplish  this,  a  modal  analysis  of  the  linear  system  was  performed. 

2.4.3  Modal  Analysis 

As  the  heading  angle  and  depth  of  the  vehicle  have  no  effect  on 
the  six  modes  (surge,  sway,  heave,  roll,  pitch  and  yaw)  a  reduced  A  ma¬ 
trix  with  the  psi  and  z  states  and  equations  deleted  was  used  in  com¬ 
puting  the  eigenvalues.  This  leaves  the  remaining  eight  eigenvectors 
(two  of  which  form  conjugate  pairs)  to  describe  the  six  degrees  of  sub¬ 
marine  motion. 

The  normalization  of  the  eigenvectors  highlights  the  issues  of  ap¬ 
propriate  dimensions.  The  state  variables  u,  v,  and  w  are  in  units  of 
feet  per  second,  p,  q,  and  r  in  radians  per  second  and  0  and  6  in  ra¬ 
dians.  There  is  no  consistent  set  of  factors  by  which  to  non- 
dimensionalize  the  Ap  matrix  (and  hence  the  eigenvectors) .  Ideally, 
each  column  of  Ap  could  be  normalized  by  its  respective  state  equilib¬ 
rium  value;  however,  in  this  instance,  most  of  the  equilibrium  states 
are  essentially  zero  ( see  Table  C. 1 ) . 

In  order  to  more  appropriately  view  the  eigenvectors,  the  three 
linear  velocities  of  each  eigenvector  were  normalized  by  the  largest 
among  u,  v  and  w.  The  three  angular  velocites  and  two  angles  ( $  and  9) 
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TABLE  2.2 

Twenty  Knot  Linear  System  Eigenvalues 

0.000000 

0.000000 

-.011766 

-.014427  ±  0.016029 
-.025288 

-.141521  ±  0.365928 

-.296676 

-.329816 


TABLE  2.3 

Twenty  Knot  System  Transmission  Zeros 

-.025288 

-.13902  ±  0.36063 
-.16079 
-.17617 
+.48846 


were  likewise  normalized  among  themselves.  Thus,  while  we  are  not  able 
to  compare  the  contribution  to  each  mode  from  each  state  on  a  uniform 
basis,  we  may  still  gain  an  adequate  feel  for  the  individual  state  con¬ 
tribution  to  each  mode  by  the  previously  described  normalization  method. 

Figure  2.5  plots  for  each  eigenvalue,  the  dominant  components  of 
its  normalized  eigenvector.  The  plots  give  an  indication  of  the  direc¬ 
tions  (in  state  space)  in  which  each  eigenvalue  is  important.  Also,  by 
analyzing  which  states  are  dominant  in  a  particular  mode  (eigenvector), 
one  can  associate  with  each  mode  a  particular  state.  This  information 
is  also  indicated  on  the  plots  of  Figure  2.5. 

2.4.4  Multivariable  Zeros 

Table  2.3  lists  the  transmission  zeros  of  the  system.  There  is  a 
non-minimum  phase  (NMP)  zero  at  +0.488.  At  present  it  is  not  clear  pre¬ 
cisely  how  NMP  zeros  can  be  handled  so  that  they  do  not  adversely  affect 
control  system  performance.  It  is  known  that,  if  a  right-half  plane 
zero  is  within  the  bandwidth  of  the  system,  it  will  impose  severe  limi¬ 
tations  on  system  performance  [5,15].  However,  if  the  NMP  zero  is  above 
crossover  (outside  the  bandwidth)  it  is  expected  that  its  adverse  affect 
will  be  greatly  attenuated. 

2.4.5  Controllability  and  Observability 

It  is  instructive  to  ascertain  whether  or  not  the  linear  model  is 
controllable  and  observable.  This  is  due  to  the  fact  that, if 
[Ap,Bp]  is  a  controllable  pair  (hence,  stablizable)  and  [Ap,Cp] 
is  an  observable  pair  (implying  detectable) ,  then  one  is  guaranteed  that 
at  least  one  set  of  control  and  filter  gain  matrices  exist  such  that  the 
closed-loop  compensated  system  is  stable. 

A  system  is  controllable,  if  the  input  u  can  control  the  complete 
state  x  of  the  system.  'fliis  implies  every  mode  is  affected  by  at  least 
one  input.  As  the  system,  described  by  the  linear  time  invariant 
matrices  Ap,  Bp  and  Cp  has  repeated  eigenvectors  and  Ap  is 
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singular,  the  method  used  to  ascertain  system  controllability  is 
Rank! Bp, Ap, Bp,  Ap  Bpl*P*  (2*7) 

If  the  rank  p,  is  equal  to  the  order  of  the  system,  n  (ten  in  this 
case),  the  system  is  controllable. 

A  system  is  observable,  if  the  complete  state  of  the  system  cam  be 
ascertained  from  observing  the  output  y.  This  implies  every  mode  is 
connected  to  at  least  one  output,  ttie  test  for  observability  used  here 
was 

Rank[Cp,ApCp, . . . . ( Ap) )  (2.8) 

If  the  rank  of  the  above  matrix  is  equal  to  the  system  order,  n,  the 
system  is  observable.  By  forming  the  above  matricies  and  determining 
their  ranks,  the  system  was  found  to  be  both  observable  and 
controllable. 

2.4.6  Open  Loop-Plant  Singular  Values 

In  the  multivariable  case,  the  best  extension  of  the  Bode  plot 
concept  of  single  input,  single  output  (SISO)  systems  is  a  plot  of  the 
transfer  matrix  singular  values.  Briefly,  singular  values  of  a  matrix 
M,  o(M),  are  a  function  of  frequency  and  are  defined  as: 

a. (M)  -  Jo. (M*M)  (2.9) 

1  —  1  —  — 

where:  ■  itl1  singular  value 

■  itJl  eigenvalue  of  M 
M*  -  the  complex  conjugate  transpose  of  M 
For  our  purpose,  we  substitute  the  plant  transfer  function  matrix,  G(s) 
for  M  [3],  where 


(2.10) 


G(s)  *  Cpfsfr-Ap)"1!^ 

and,  using  a  computer  routine,  the  singular  values  of  G(s)  as  a  function 
of  frequency  are  calculated  and  plotted.  Figure  2.6  is  the  plot  of 
singular  values  of  the  open-loop  transfer  function  G(s)  for  the  twenty 
knot  linear  model. 

The  maximum  singular  value  is  dominated  by  the  depth,  the  minimum 
by  the  heading  angle.  Notice  that  the  crossover  frequency  of  the 
maximum  singular  value  is  approximately  1.0  radian  per  second  while  the 
minimum  singular  value  crossover  occurs  at  about  0.13  radians  per 
second.  This  implies  that  the  submarine  naturally  responds  more  quickly 
in  depth;  and  also,  that  designing  a  controller  which  is  too  fast 
(crossover  greater  than  0.13  in  the  psi  channel)  will  attempt  to  drive 
the  vehicle  faster  than  it  could  naturally  respond.  Finally,  it  is 
noted  that  the  maximum  singular  value  corresponding  to  depth  crosses 
over  beyond  the  NMP  zero.  In  designing  the  controller  it  will  be 
advantageous  for  the  singular  values  to  cross  over  at  a  lower  frequency; 
first,  because  the  crossover  frequency  should  be  well  below  unmodeled 
and  other  undesirable  dynamics  so  as  to  attenuate  their  effects  and, 
second,  so  that  the  NMP  zero  will  be  outside  the  closed-loop  system’s 
bandwidth. 

2.5  Chapter  Summary 

Idle  physical  system  to  be  controlled  along  with  some  of  its 
particular  dynamic  characteristics  were  discussed.  The  nonlinear 
equations  of  motion,  based  on  the  NSRDC  2510  report  and  their  linearized 
counterparts  for  straight  ahead  motion  at  twenty  knots,  were  presented. 

The  linear  model  at  twenty  knots  was  successfully  verified  by 
comparing  the  linear  and  nonlinear  model  responses  to  similar 
perturbations.  It  was  found  that  for  periods  of  less  than  thirty 
seconds,  the  responses  were  nearly  identical.  Finally,  the  dynamics  of 
the  twenty  knot  linear  model  were  investigated,  in  the  next  chapter, 
time  and  frequency  domain  specifications  will  be  developed. 
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FREQUENCY  (RRD/SEC) 


Figure  2.6:  Singular  Values  of  the  Twenty  Knot 
Open -Loop  Plant 
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3.  CONTROLLER  SPECIFICATIONS  AND  ROBUSTNESS 


3.1  Introduction 

In  this  chapter  some  desirable  attributes  of  an  automatic  heading 
and  depth  controller  will  first  be  qualitatively  discussed.  Next,  a  set 
of  frequency  domain  specifications  will  be  derived  which  will  serve  as  a 
basis  for  the  compensator  design  of  Chapter  4.  Time  domain  specifica¬ 
tions  will  also  be  presented  against  which  the  resultant  compensator 
shall  be  tested.  Finally,  the  concept  of  robust  multivariable  control 
is  discussed  and  the  definiition  of  multivariable  phase  and  gain  margins 
given. 


3.2  General  Specifications 

There  are  no  clearly  stated  design  specifications  which  this  par¬ 
ticular  compensator  is  required  to  meet.  The  time  domain  figures  used 
herein  are  the  designers  goals  based  on  several  discussions  with  opera¬ 
tional  personnel.  In  general  terms,  it  is  desired  that  a  multivariable 
controller  be  designed  for  use  as  an  "autopilot"  to  maintain  course  and 
depth  in  the  presence  of  disturbances  such  as  shifting  currents.  It  is 
envisioned  that  the  compensator  be  activated  when  the  submarine  is  near 
its  ordered  course  and  depth.  This  implies  that  the  compensator  be  able 
to  response  favorably  to  step  inputs  (in  psi  and  z)  as  it  is  unlikely 
that  the  submarine  will  be  precisely  at  the  ordered  heading  or  depth 
when  the  automatic  control  system  is  activated.  Further  it  is  required 
that  the  controller  be  able  to  alter  the  course  and  depth  of  the  sub¬ 
marine  in  response  to  either  step  or  ramp  inputs  in  heading  and  depth 
with  small  steady  state  errors.  Another  requirement  is  that  the  control 
system  allow  the  vehicle  to  accomplish  a  level  turn,  that  is,  undergoing 
very  little  depth  excursion  while  making  a  turn.  Finally,  as  the  multi- 
variable  controller  is  not  to  be  designed  for  rapid/critical  maneuvers, 
the  speed  of  response  is  not  of  primary  importance. 
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The  MI MO  extension  of  a  bode  plot  is  a  plot  of  the  singular  values 
of  the  transfer  matrix.  Referring  to  Figure  3.1,  in  the  frequency 
domain,  it  is  required  that  the  stable,  closed-loop  compensator  have 
good  command  following,  input  and  output  disturbance  rejection,  and  low 
sensitivity  to  modeling  errors  and  sensor  noise.  Thus,  one  desires  the 
minimum  singular  value  to  have  high  DC  and  low  frequency  gains  for  good 
command  following  and  disturbance  rejection  while  at  higher  frequencies 
where  unmodeled  dynamics  and  sensor  noise  typically  have  their  energy, 
the  maximum  singular  value  should  be  small  and  roll  off  rapidly. 

In  the  time  domain,  the  control  design  should  mimimize  any  oscilla 
tory  response  or  overshoot,  'rtiis  takes  priority  over  the  speed  of 
response  for  the  present  design  objectives.  Generally,  an  overdamped 
response  is  considered  desirable.  Small  steady  state  errors  are 
required . 


3.3  Specification  Development 

First  we  shall  set  some  guidelines  in  the  frequency  domain.  Having 
no  other  criteria,  the  surface  wave  frequency  spectrum  was  used  to 
deduce  some  maximum  crossover  frequency  limits.  As  discussed  in 
reference  [17],  the  surface  wave  spectrum  has  a  frequency  range 
typically  between  0.2  and  2  radians  per  second.  The  frequency  of 
encounter,  <i>e,  between  the  sea  spectrum  and  a  moving  vehicle  is  a 
function  of  the  sea  spectrum  frequency,  the  angle  between  the  vehicle 
and  direction  of  propagation  of  the  dominant  wave  front  and  vehicle 
speed.  Specifically,  from  reference  [13],  within  linear  theory: 

2 

(0  *  uiZ  -  — -  cos 4*  (3.1) 

e  g 


where:  u  *  ship  speed  in  ft/sec 
g  ■  gravity 

(i)  m  wave  spectrum  frequency 

■  direction  of  the  vehicle  relative  to  the  direction 
of  wave  probagation  (180  for  head  seas) 
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Figure  3.1.  Plot  of  singular  values  versus  frequency. 
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Hie  worst  case  (lowest  crossover)  is  for  following  seas  (psi-O)  in 
the  presence  of  low  frequency  waves  (u  -  0.2).  Thus,  for  various 
speeds,  the  encounter  frequencies  presented  in  Table  3.1  gives  some 
indication  of  frequencies  above  which  the  controller  should  attenuate 
energy. 


TABLE  3.1:  Encounter  Frequencies 

Speed  (Knots)  Bicounter  Frequency 

30  .137 

20  .158 

10  .179 

5  .189 

Sensor  noise  is  well  above  this  range:  and,  therefore,  it  will  be 
readily  attenuated  by  a  compensator  designed  according  to  the  above 
considerations  for  crossover.  Note  also  that  the  NMP  zero  at  +.488  is 
well  above  the  indicated  crossover  frequency. 

In  setting  a  lower  frequency  "limit",  one  may  use  the  settling  time 
allowable.  Here,  the  settling  time  is  the  time  required  to  reach  and 
stay  within  10  percent  of  the  reference  value.  From  experience, 
reasonable  settling  times  for  a  significant  couse  (10  degrees)  and  depth 
(30  feet)  changes  as  a  function  of  speed  are  shown  in  Table  3.2  If  one 
assumes  that  the  steady  state  is  reached  in  approximately  four  time 
constants,  we  are  left  with  an  indication  of  the  lower  frequency  limit 
for  crossover. 


TABLE  3.2:  Settling  Times  and  Crossover  Frequencies 


Speed  ( Knots ) 

Settle  Time  (sec) 

Frequency 

30 

100 

.040 

20 

200 

.020 

10 

300 

.013 

5 

400 

.010 

A  tight  crossover  pattern  is  indicated  by  the  above  analysis.  As 
the  minimum  singular  value  (corresponding  to  psi)  was  found  to  have  a 
crossover  of  about  0.13  radians  per  second  along  with  the  considerations 
above,  the  twenty  knot  controller  shall  be  designed  with  crossovers  of 
between  .02  and  0.13  radians  per  second.  Since  the  DC  gain  appears  to 
increase  with  larger  bandwidths  for  this  system,  it  is  advantageous  to 
design  at  or  near  a  crossover  frequency  of  0.13  radians  per  second.  It 
is  emphasized  that  these  ranges  are  guidelines  rather  than  strict 
limits.  Further,  it  should  be  noted  that  the  design  procedure  to  be 
discussed  in  Chapter  4  would  apply  equally  as  well  to  a  different  set  of 
specifications . 

In  the  time  domain,  the  specifications  to  be  met  include  the 
settling  times  (Table  3.2)  for  simultaneous  10  degree  and  30  foot  step 
perturbations.  Additionally,  any  overshoot  or  oscillatory  response  is 
to  be  minimized  but,  from  experience,  acceptable  figures  are  20  feet  in 
depth  and  5  degrees  in  heading. 

The  allowable  deviation  in  depth  during  a  course  change  is  a 
function  of  vehicle  speed.  The  currently  acceptable  figures  are: 

TABLE  3.3:  Depth  Excursion  Limits 
Speed  Allowable  Depth  Excursion 


<10  kts. 
10-20  kts 
>20  kts. 


10  feet 
15  feet 
20  feet 
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Heading  deviations  during  a  depth  change  are  to  be  limited  to  three 
degrees. 

Of  considerable  importance  is  the  allowable  steady  state  error.  An 
acceptable  absolute  value  for  heading  error  is  less  than  one  degree 
while  depth  error  should  be  less  than  five  feet.  A  more  useful  specifi¬ 
cation  for  steady  state  error  is  a  percentage  of  the  required  change  or 
deviation.  Obviously,  we  should  expect  larger  errors  for  greater  course 
and  depth  changes,  it  is  the  objective  of  the  design  to  maintain  a 
three  percent  or  less  steady  state  error  using  the  nonlinear  simulation. 

Finally  there  is  the  issue  of  rate  limitations  on  the  control  sur¬ 
faces.  The  state  of  the  art  for  the  size  of  the  control  surfaces  and 
vehicle  speeds  in  this  design  is  12  to  15  degrees  per  second.  This  lim¬ 
itation  was  not  explicitly  included  in  the  compensator  design  or 
programmed  in  the  simulation  but  must  be  kept  in  mind  when  deciding  if  a 
particular  controller  is  acceptable. 

3.4  Robustness 

The  issue  of  robustness  deals  with  the  fact  that  any  model  is  at 
best  an  approximation.  Usually  the  model  is  a  relatively  low  order 
linear  time  invariant  approximation  in  which  modeling  errors  predomi¬ 
nantly  manifest  themselves  at  higher  frequencies.  These  high  frequency 
modeling  errors  include  neglected  dynamics  (for  instance  from  the 
assumption  of  rigid  body  motion) ,  time  delays  and  neglected  nonlineari¬ 
ties.  The  basic  concern  is  to  find  the  extent  to  which  the  nominal 
design  values  of  the  plant  model  can  deviate  without  causing  system 
instability. 

For  purposes  of  this  discussion,  the  feedback  system  is  as  shown  in 
Figure  3.2,  with  the  loop  transfer  matrix,  G(s),  incorporating  both  the 
plant  dynamics  and  any  compensation  utilized. 


-  43 


For  tha  single  input  single  output  (SISO)  case,  the  Nyquist 
stability  criterion  not  only  informs  one  if  the  closed-loop  system  is 
stable  but  also  allows  one  to  graphically  visualize  the  stability 
margins  (robustness)  of  the  system  by  viewing  the  locus  of  g(s)  (scalar 
G(s))  in  relation  to  the  critical  point  [12].  For  the  MIMO  case,  the 
multivariable  Nyquist  criterion  [5,11,12]  answers  the  question  of 
asymptotic  nominal  closed-loop  stability,  but  does  not  indicate  the  sort 
or  size  of  errors  which  will  drive  the  system  unstable.  In  order  to 
obtain  a  measure  of  robustness  (i.e.,  stability  margins)  in  the  MIMO 
system  one  must  use  singular  values. 

As  stated  above,  the  actual  plant,  G(s),  differs  from  the  nominal 
plant,  G(s),  because  of  modeling  approximations  and  errors,  there  are 
many  ways  in  which  to  model  these  errors.  The  most  common  ways  are  as 
additive  or  multiplicative  errors.  For  additive  errors  we  have 

G(s)  -  G(s)  +  E(s)  (3.2) 

where  E(s)  is  the  error  matrix.  For  multiplicative  errors  we  find 

G(s)  -  G(s)  U+E(s)]  (3.3 

It  can  be  shown  [11]  that  for  additive  (or  division)  errors  the 
system  will  be  on  the  verge  of  instability  when 

det[£  +  G(s)]  -  0.  (3.4) 

Similarly,  for  multiplicative  (or  subtractive)  errors  the  verge  of 
instability  in  the  MIMO  case  is  [11,12]. 


det[I  +  G- 1 (s)]  -  0 


In  terns  of  the  MIMO  Nyquist  criterion,  this  is  where  the  number  of 
nominal  encirclements  of  the  critical  point  changes. 

In  terms  of  singular  values  we  are  interested  in  the  smallest  JS(s) 

such  that  the  return  difference  transfer  matrix  ([Jt  +  G(s ) ]  or 
[I_  +  G-1  ( s )  ] )  is  singular.  It  has  been  shown  [11,12]  that,  if  the 
following  conditions  hold: 


1.  Hie  actual  (♦ol<8))  nominal  Ho^ia))  open-loop 
characteristic  polynominals  have  the  same  number  of  right  half 
plane  (RHP)  roots  (unstable  poles). 

2.  If  $oLtjMo>  ■  0  then  $OLtj“o)  *  0 

3.  $cl(s )  has  no  RHP  zeros  (no  unstable  poles) 

then  the  actual  closed-loop  polynominal  ($cl<3 ) )  will  have  no  RFP 
roots  if 

a.  For  the  additive  or  division  error  models 


aminl(i+  £( j“)J  >  Pmay[E( jai)] 


b.  For  the  multiplicative  or  subtractive  error  models 


(3.6) 


amin  ( ju> )  ]  >  ^E(  j(i) )  1 » 


(3.7) 


The  requirement  for  robust  control  for  multiplicative  error  can  be 
visualized  as  shown  in  Figure  3.3.  Thus,  one  may  ensure  the  robustness 
of  the  system  under  consideration  using  the  above  inequalities,  if  an 
error  matrix  can  be  adequately  estimated.  However,  if,  as  in  our  case, 
there  is  no  good  estimate  of  the  error  margin,  other  means  must  be  used 
to  check  for  robustness. 

He  shall  examine  the  MIMO  gain  and  phase  margins  as  developed  in 
reference  [12].  If  the  three  previously  stated  conditions  hold  and 


amint£  +  £(■>!  >  « 


(3.8) 


or 


a  mint  I.  +  G-1  (s)  ]  >  8 


(3.9) 


then  the  guaranteed  phase  (PM)  and  gain  (GM)  margins  are  given 
respectively  by: 


or 


GM  - 


t+a 


(3.10; 


PM  ■  +COS  [1 - ~] 


(3.11) 


ffl«  [1  +  J] 


(3.12) 


-1  8 

PM  ■  jf  COS  [1  -  — —  I  . 


(3.13) 


It  should  be  noted  that  the  phase  and  gain  margins  are  somewhat 
conservative  in  the  sense  that  the  gains  or  phases  of  all  the  feedback 
loops  may  be  changed  simultaneously  without  destabilizing  the 
closed-loop  system.  In  fact,  individual  loops  may  have  larger  margins, 
taken  one  at  time.  For  the  submersible  we  shall  not  set  specific 
margins  but  evaluate  the  controller  to  ascertain  its  robustness. 
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3.5  Chapter  Summary 

The  present  chapter  has  developed  a  set  of  frequency  domain  specif¬ 
ications  to  which  a  controller  can  be  designed.  In  order  that  the  com¬ 
pensator  may,  once  designed,  be  tested  and  validated,  time  domain  spec¬ 
ifications  have  also  been  presented.  Finally,  the  basic  ideas  of  com¬ 
pensator  robustness  were  discussed  in  terms  of  modeling  errors  with 
multivariable  phase  and  gain  margin  definitions  given.  In  chapter  4, 
the  control  design  methodology  is  developed  and  a  design  example  offered 


and  tested. 


4.  MODEL-BASED  COMPENSATOR  AND  CONTROLLER  DESIGN 


4.1  Introduction 

In  this  chapter,  a  compensator  will  be  designed  based  on  the  Linear 
Quadratic  Gaussian  (LQG)  with  Loop  Transfer  Recovery  (LTR)  procedure. 

We  will  first  discuss  the  Model-Based  Compensator  (MBC)  and  the  aug¬ 
mented  dynamics;  then,  the  Loop  Transfer  Recovery  (LTR)  design  procedure 
is  employed  to  meet  the  frequency-domain  specifications.  A  design  exam¬ 
ple  using  the  twenty  knot  linear  model  is  then  presented.  Finally,  we 
shall  test  the  compensator  design  using  both  linear  and  nonlinear  simu¬ 
lations. 

The  control  specifications  will  be  met  by  loop-shaping  the  singular 
values.  In  order  to  meet  the  performance  specifications  of  small 
steady-state  errors,  we  desire  high  DC  gains.  To  ensure  modeling  errors 
will  not  cause  closed-loop  instability  we  desire  a  crossover  of  about 
0.1  radians  per  second  with  a  large  roll-off  after  crossover.  This  will 
ensure  attentuation  of  the  high  frequency  modeling  errors  and  sensor 
noise. 


4.2  Model-Based  Compensator  Structure 

The  MBC  is  a  class  of  MIMO  compensators  which  can  be  constructed 
using  the  results  of  optimal  control  theory  ( the  linear  quadratic  state 
feedback  problem)  and  optimal  estimation  theory  (the  Kalman  filter). 

The  MBC  has  the  property  that,  when  cascaded  with  a  MIMO  open-loop 
plant,  the  resultant  closed-loop  plant  will  be  stable,  provided  the  con¬ 
stant  gain  parameters  discussed  below  are  properly  selected.  Thus,  the 
designer's  objective  is,  given  an  open-loop  plant,  to  select  a  compensa¬ 
tor  which  ensures  stability  of  the  closed-loop  system  and  achieves  the 
desired  loop  shapes  in  the  frequency  domain  using  singular  values. 

Figure  4.1  illustrates  the  desired  feedback  structure  of  the  MIMO  con- 
tror  system  with  the  disturbances,  d(s),  reflected  to  the  plant  in¬ 
put.  Although  Linear-Quadratic-Gaussian  stochastic  optimal  control 
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theory  is  used  to  obtain  the  numerical  solutions  for  the  gains  of  the 
MBC,  the  implications  of  the  word  ‘‘optimal11  should  be  deemphasized. 
this  is,  among  other  reasons,  because  the  designer  varies  the  free 
parameters,  in  a  systematic  way,  without  regard  to  stochastic  optimality 
considerations,  in  order  to  obtain  good  compensators. 

Figure  4.2,  from  reference  [6],  illustrates  the  internal  state- 
space  description  of  the  MBC  (K(s))  and  the  open-loop  plant,  Gp(s). 

Note  that  the  A,  B,  and  £  matrices  describing  the  plant  appear  in  the 
compensator,  j((s),  as  well  as  in  the  plant  transfer  function  matrix, 
6p(s).  Bie  term  MBC  is  used  due  to  the  explicit  way  the  nominal  model 
of  the  open-loop  plant,  Gp(s),  shows  up  in  the  compensator,  K(s). 

The  open  loop  dynamics  of  the  plant  are 

x(t)  =»  Ax ( t)  +  Bu( t)  +  1/3 (t)  (4.1) 

y(t)  -  Cx(t)  (4.2) 

where  L  is  a  design  parameter  which  may  be  varied  so  that  an  open-loop 
system  can  be  constructed  to  reflect  the  specifications.  The 
closed-loop  compensated  system  will  then  be  required  to  match  this 
open-loop  performance.  The  control-to-plant  transfer  function  is 

Gp(s)  -  C(sl  -  A)-1B.  (4.3) 

The  MBC  dynamics  are 

Z(t)  »  ( A-BG-HC] Zj t)  -  He(t)  (4.4) 

u(t)  -  -Gz(t)  (4.5) 

where  z{t)  is  the  estimated  state  vector  (of  the  same  dimension  as  the 
plant  state  vector),  r(t)  is  the  reference  input  vector,  e(t)  is  the 


Figure  4.2.  State  space  description  of  the  MBC. 
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error  vector  (e^(t)  -  j:(  t)-y(  t) )  and  u(t)  is  the  output  vector  of  the 
MBC.  The  control  gain  matrix,  G,  and  filter  gain  matrix,  H,  are  design 
results  which  together  determine  the  poles  and  zeros  of  the  MBC.  The 
MBC  transfer  matrix,  Ki,qg(s),  is  given  by 

KlQG(s)  *  G ( Sl-A+BG+HC) “ 1 H  (4.6) 


where 


«(*)  -  Kj.QGiaJets) .  (4.7) 

A  closed  loop  representation  of  the  cascaded  plant  and  compensator 
is  derived  in  reference  [2]  as 


x(t) 

m 

A-BG  BG 

x(t) 

L  0 

d(t) 

wm 

_0  A-HC 

w(t) 

+ 

L  -H 

am  =* 

rl  t) 

where  a  change  of  variables  has  been  used  with 


(4.8) 


w(t)  -  x( t)  -£(t).  (4.9) 

The  vector  w(t)  is  simply  the  error  of  state  estimation. 

Hie  above  2n  dimensioned  vec _ equation  completely  describes  the 

closed-loop  system.  Given  A,  li,  and  C,  the  selection  of  H  and  G  will 
determine  the  closed-loop  dynamics  from  which  one  may  calculate  the 
closed-loop  response  to  disturbances  and/or  command  inputs.  It  can  be 
shown  [2,3,6]  that  closed-loop  stability  decomposes  into  two  separate 
problems  as  follows: 

Given  A  and  B,  find  G- such  that  the  real  parts  of  the 
eigenvalues  of  (A  -  BG)  are  less  than  zero. 


1 


2 


Given  A  and  C,  find  H  such  that  the  real  parts  of  the 
eigenvalues  of  (A  -  HC)  are  less  them  zero. 

From  linear  system  theory  [10]  it  can  be  shown  that  the  feedback 
system  of  Figure  4.2  can  be  made  closed-loop  stable  by  appropriate 
selection  of  H  and  G,  provided  that  [A,J3]  is  a  stablizable  pair  and 
[A,C]  is  a  detectable  pair.  In  fact,  as  discussed  in  chapter  2,  the 
twenty  knot  linear  model  satisfies  the  stronger  controllability  and 
observability  conditions. 

4. 3  Calculation  of  the  Gain  Matricies 

The  procedure  for  calculating  <3  and  II  is  based  on  the  LQG 
stochastic  optimal  control  theory  [10,16].  Recall  that,  in  the  Linear 
Quadratic  Regulator  problem  we  attempt  to  minimize  the  quadratic  cost 
functional 


J  -/  [x'(t)@c(t)  +  u' (t)Ru(t)]dt  (4.10) 

where  the  R  matrix  is  the  control  weighting  matrix  and  £)  is  the  state 
weighting  matrix. 

The  control  gain  matrix  G  is 

G  -  R~ 1  BP  (4.11) 

where  R  is  an  arbitrary  symmetric,  positive  definite  (mxn)  matrix  (m 
being  the  number  of  inputs  and  ouputs)  and  P_  is  the  solution  to  the 
control  algebraic  Riccati  equation  (CARE) 

o  -  -PA  -  A'P  -  £  +  PBR-1B'P  (4.12) 

In  this  development  £  is  an  arbitrary  (nxn)  symmetric,  positive 
semi-definite  matrix  given  as 


2  “  ii'li 


(4.13) 
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such  that  (A,M)  is  detectable  [2]. 

The  filter  gain  matrix,  H,  is  found  using  the  Kalman  filter 
algorithm  with 

H  -  PC'S-1  (4.14) 


where  j3  is  symmetric,  positive  semi-definite  and  is  given  as 

S  -  MM'  (4.15) 

and  H  is  an  arbitrary  matrix  of  suitable  dimensions  with  [A,M] 
stablizable.  The  p  matrix  is  the  solution  of  the  filter  algebraic 
Riccati  equation  (FARE) 

0  -  PA  +  A'P  +  £  -  FC'  BJ^CF  (4.16) 

where  6_  is  an  arbitrary,  symmetric,  (mxm) ,  positive  definite  matrix. 

The  control  engineer  has  considerable  freedom  in  selecting  the 
parameters  of  the  design,  in  fact,  one  may  use  L,  N,  H,  R  and  _6 
directly  as  design  parameters.  Obviously,  this  freedom  is  of  great 
disadvantage  without  a  method  of  rationally  and  systematically  selecting 
these  parameters.  The  LTR  method  provides  such  an  algorithm.  Before 
the  LTR  procedure  is  presented,  we  shall  augment  the  plant  dynamics  as 
discussed  below. 

4.4  Control  Surface  Dynamics  and  Augmentation 
4.4.1  Actuator  Dynamics  and  Augmentation 

In  order  to  reduce  the  number  of  neglected  dynamics,  it  is 
desirable  to  include  in  the  linear  model  the  dynamics  of  the  actuators 
(rudder  and  sternplanes) .  The  actuators  are  more  accurately  described 
by  second  order  systems  (Table  4.1 )»  however,  as  the  damping  ratio 
approaches  unity,  the  second  order  harmonics  disappear,  in  order  to 
reduce  the  model  size  and  because  the  control  surfaces  are  heavily 
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the  actuators  sera  satisfactorily  approximated  with  a  first  order 
representation  of  the  form 


(1/T) 

S  +  (1/T ) 

with  the  constant  t  bain?  derived  from  the  original  second  order 
dynamics. 


TABLE  4.1:  ACTUAL  DYNAMICS  (Second  Order) 


Sternplanes: 

u>  -  3.14  radians/sec 

C  -  .9 

o  ■  C(D  ■  2.83  radians/sec 

Rudder: 

o)  -  2.51  radians /sec 

5  -  .9 

a  -  -  2.26  radians/sec 

Now;  from  reference  [13],  using  the  definition  of  the  time  constant 
for  a  second  order  system  with  critical  damping 


we  find 


t  -  l/o 

1/Tr  ■  2.33/sec 


1/T8  -  2.26/sec 

As  the  projected  crossover  frequency  is  on  the  order  of  one  tenth  of  a 

radian  per  second,  it  was  clear  that  the  actuator  dynamics  would  not 

have  a  large  influence  on  the  design.  However,  in  order  to  increase 

roll-off  near  crossover,  it  was  decided  to  use  lag  compensation  at  0.1 

radians  per  second  instead  of  the  approximate  control  surface  dynamics. 

This  will  increase  the  roll-off  above  the  crossover  frequency,  making 

the  vehicle  less  susceptable  to  modeling  errors  and  high  frequency 

sensor  noise.  Therefore,  the  system  was  augmented  with  two  lag 

compensators  as  shown  in  Figure  4.3. 
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The  state  space  representation  of  the  augmented  dynamics  is  shown 
in  Figure  4.4.  For  the  lag  compensation  previously  developed  we  have 


and  G.(s),  the  2  by  2  augmentation  transfer  matrix  is 


G*(s)  >  S»(sl-i9l"  )B,. 


(4.19) 


4.4.2  Overall  System  Model 


The  MI MO  feedback  system  with  the  augmented  dynamics  G^(s)  is  as 
shown  in  Figure  4.5.  Since  G^fs)  is  decided  by  the  control  designer, 
it  is  justifiably  part  of  the  overall  compensation  K(s)  (it  is  this 
overall  compensation  that  is  incorporated  in  the  simulation),  with 


K(s)  -  GafsjK^QGts)  (4.20) 

and  it  is  only  the  compensation  denoted  as  K^qq(s)  which  will  be 
designed  by  the  LQG/LTR  methodology  presented  later. 


For  designing  K^qqCs)  we  first  need  to  define  the  "plant" 
transfer  matrix  G(s)  as 

G(s)  -  GptsjGjjfs)  (4.21) 

as  illustrated  in  Figure  4.5.  Note  that  the  "plant”  consists  of  the 
nominal  plant,  Gp(s),  and  the  augmented  dynamics  G^s).  Also  note 
that  the  input  to  the  "plant" ,  u( t)  is  not  the  physical  input  Up( t) , 
but  that  the  output  y( t)  is  the  same  for  either  plant  definition 
(augmented  or  unaugmented).  In  the  present  design  Kj,qg(3)*  G^ts), 
and  Gp(s)  are  all  two  by  two  transfer  matrices. 

In  the  frequency  domain  the  nominal  plant,  Gp(s),  is  defined  as 

Gp( s)  -  Cp(sI-Ap)_1Bp  (4.22) 

where  Ap  is  a  ten  by  ten  matrix.  Bp  is  a  ten  by  two  matrix  and  Cp 

is  a  two  by  ten  matrix.  The  development  of  the  specific  plant  matrices 

was  presented  in  Chapter  2. 

Combining  the  augmentation  dynamics  and  nominal  plant  yields  an 
overall  plant  transfer  matrix 

G(s)  -  C(sjC-A)_1B  (4.23) 

where  A  is  a  12  by  12  matrix,  B  is  a  12  by  2  matrix  and  C  a  2  by  12 
matrix.  Figure  4.6  displays  the  state  space,  time  domain  representation 
of  the  overall  open- loop  "plant". 

To  develop  the  form  of  the  A,  B,  and  C  matrices  we  start  by 
defining  the  12  by  1  state  vector  as 


where  x  (t)  consists  of  the  original  ten  state  variables  listed  in  Table 
2.1  and  x^t)  are  the  two  augmentation  states. 

The  overall  plant  in  state  space  form  is  now  given  by 


where 


*(t)  -  Ax ( t)  +  Bu(t) 


(4.25) 


y(t)  -  Cx(t) 


(4.26) 


A  -  Ap(  10x10)  BpC3 

1  (10x2) 

£  (2x10)  A* 

j  (2x2) 


(10x2) 


B,(2x2) 


—  -  e  — * 

C  -  Cp(2x1 0)  .  O 

.  (2x2) 

e 


The  addition  of  the  first  order  lag  compensation  at  0.1  radian  per 
second  increased  the  order  of  the  plant  to  twelve.  This  augmentation 
added  two  poles  at  0.1  but  did  not  change  the  transmission  zeros. 

The  singular  values  of  the  augmented  open-loop  plant  were 
calculated  and  are  shown  in  Figure  4.7.  As  expected,  the  augmented 
plant  singular  values  roll-off  more  quickly  at  frequencies  above  0.1 
radian  per  second  as  compared  to  the  unaugmented  plant.  The  crossover 
frequencies  occur  at  0.48  and  0.1  as  compared  to  the  unaugmented  plant 
crossovers  of  1.0  and  0.13  radians  per  second.  The  faster  roll-off 
should  enable  the  designer  to  more  easily  meet  the  crossover  and 
robustness  specifications.  With  the  augmented  plant  A,  _B,  and  C 
matrices  (shown  in  Table  C.3  of  Appendix  c)  developed,  the  loop  transfer 
recovery  control  design  methodology  will  now  be  discussed. 


4.5  Compensator  Design  Methodologies 

The  LTR  procedure  allows  one  to  systematically  design  an  LQG- based 
compensator,  K(s) ,  given  a  nominal  open-loop  plant  Gp(s).  We  shall 
systematically  select  and  iterate  on  the  free  design  parameters  L,  _9, 
and  R.  Specifically,  we  desire  to  shape  the  singular  values  of  the  loop 
transfer  matrix,  T(s),  where 


T(s)  -  Gp(s)R(s) 


(4.27) 


over  the  appropriate  frequency  range  such  that  the  specified 
performance/robustness  properties  of  good  command  following,  output 
disturbances  rejection  and  insensitivity  to  modeling  errors  are  met. 
flm  LQG /LTR  method  presented  here  (and  detailed  in  references  [2]  and 
[5]),  consists  of  first  shaping  the  singular  values  of  the  Kalman  filter 
loop  transfer  matrix  and  then  recovering  the  same  loop  transfer  matrix 
for  T(s)  using  the  dual  of  the  Kwackernaack  recovery  method  [10]. 


The  first  step  is  based  on  the  Kalman  filter  (KF)  frequency  domain 
equality. 


<I^KF  (8))  +  <I^KF  <9))*  "I  +^L(s)£fOL(S>‘  (4*28) 

where 

GyoLts)  -  Ctsl-A)-1!  (4.29) 

and 

Gjtf  (s)  -  C(s£-A)-1H.  (4.30) 

The  A  and  C  matrices  are  for  the  augmented  plant,  is  for  the  filter 
gain  matrix  and  u  and  are  design  parameters.  At  low  frequencies  it 
can  be  shown  [2]  that  as  the  frequency  approaches  zero. 


ai[GKp(s)l 


W8)]* 


(4.31 ) 


Thus  the  first  step  is  to  select  L  and  m  such  that  the  specifica¬ 
tions  (command  following,  disturbance  rejection  and  crossover)  in  the 
frequency  domain  are  met  by 

o^£F0l( J»)l.  (4.32) 

Now  the  FARE,  of  the  form 

£  *  L'L  +  FA  +  LL'  -  FC'e^CF  (4.33) 

is  solved  for  _F  using  u  and  9_  as  arbitrary  design  parameters  (usually  0^ 
is  taken  as  the  identify  matrix  due  to  considerations  detailed  in 
reference  [12]).  The  KF  gains  are  then 

H  -  FC’8"1  (4.34) 
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Hie  singular  values  of  the  filter  transfer  matrix,  Gjcp(s),  are  made  to 
match,  as  closely  as  possible,  the  singular  values  of  Gpoi/3)'  by 
iterating  on  the  scalar  u .  That  is,  we  select  y  such  that  for  the 
previously  obtained  (selected  to  meet  the  stated  frequency-domain 
specifications)  we  have 


ffl-2-  G_nT (s ) ) 
1  —  — FOL 


(4.3! 


At  this  point  the  robustness  of  the  KF  is  checked  by  ensuring 

otl+SKFfjw)}  >.  1  (4.36) 

a[I+G^,(-jw)]  _>  (4.3' 

These  robustness  properties  are  discussed  in  reference  [12]. 

Hie  LQG  compensator  is  now  designed  using  LTR  by  solving  the  CARE 
for  IP  whic!.  is  of  the  form 

0  -  -PA  -  A'P  -  Q  +  PBR_1B'P  (4.3) 


where 


Q  -  qC'C  (4.3! 

and  q  (a  positive  scaler)  and  II  (usually  taken  as  the  identity  matrix) 
are  the  design  parameters.  The  control  gain  matrix  G^  is  then 

G  •  R_1B'P  . 


(  4.4' 


The  singular  values  of  the  resultant  loop  transfer  matrix  a[T(jw)] 
are  now  calculated  where 

T(s)  *  G(s)Ki,qG(s)  .  (4.41) 

The  designer  iterates  on  q  (and  possibly  R)  until 

o [T( j (u ) ]  *  o[G£p(ju)]  (4.42) 

over  reasonable  frequency  ranges. 

For  all  minimum  phase  systems,  the  LTR  method  guarantees  that  the 
singular  values  of  T(s)  and  Gjcp(s)  will  coincide  as  the  3caler,  q, 
approaches  infinity.  In  NMP  systems,  if  all  non-minimum  phase  zeros  are 
beyond  the  maximum  crossover  of  <gc?(s),  then  the  singular  values  of 
T(s)  and  Gkf(s)  will  coincide  satisfactorily  at  low  frequencies.  If 
non-minimum  phase  zeros  exist  at  frequencies  below  crossover,  it  appears 
that  there  will  be  basic  limnitations  on  command-following  and 
disturbance  rejection  [21 .  Precisely  how  to  “cure"  this  is  not  known  at 
the  present  time. 

Finally,  if  the  designer  has  available  an  estimate  of  the  modeling 
error  Lp(s),  the  robustness  of  the  compensated  system  may  be  checked 
by  ensuring 


a  (L  (jto)-l]  <  a  .  (I+T-l(jw)]  (4.43) 

lu  ax  —  p  —  min  —  — 

a  ^[^(jw)-!)  <  0  .  [I+T(j(i»)J.  (4.44) 

max  —p  —  min  —  — 

Using  the  augmented,  twenty  knot  linear  model,  a  compensator  will 
now  be  designed.  It  should  be  noted  that  an  accurate  estimate  of  the 
modeling  error  was  not  available  to  the  designer.  Therefore,  the 
robustness  properties  were  not  examined  in  terms  of  Lp(s) . 
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4.6  Compensator  Design  Example 

The  first  step  of  the  design  procedure  is  to  select  an  arbitrary  L 
matrix  such  that  the  performance  specifications  are  met.  Recall  that 
the  frequency-domain  specifications  stated  that  crossover  should  be  0.13 
radians  per  second  or  less,  due  to  the  natural  crossover  frequency  of 
the  open-loop  plant  singular  values,  the  frequency  of  wave  encounter  and 
the  NMP  zero  at  0.488. 

The  matrix  was  selected  such  that  the  singular  values  would  be 
"tied  together"  both  at  low  and  high  frequencies  with  crossover  in  the 
vicinity  of  0.1  radians  per  second.  The  particular  to  accomplish  this 
was  selected  as  follows. 

At  low  frequency,  the  KF  equality  reduces  to  the  approximation 

*  oEG^jw)]  (4.45) 

/u" 


which  implies 


—  C(j(oI-A)_1L  -  G^_( jd) )  (4.46) 

nr  -  —  -  -«• 


The  idea  is  to  select  L  such  that  £( sI-A) -1 -  /jTl.  As  the  freqeuency 
approaches  zero 

£ (  -a-1 )L  -  /pi.  (4.47) 

Therefore,  we  pick  such  that 

I  -  CA_lL  (4.48) 


which  yields 


L  -  /u  AC'tCC*)"1. 


(4.49) 


5  76bvns  system,  the  A  matrix  is  singular.  Since  L  is  arbitrary,  let  A 
-  A  where  A^  is  made  non-singular  by  replacing  the  zeros  in  the  last  two 
diagonal  entries  of  A  with  unity.  The  form  of  £  in  relation  to  C  , 
makes  A  appear  as  an  identify  matrix  and  since  the  C  matrix  is  unitary 
(CC*  ■  ,  we  have 

L  -  /yC'  (4.50) 


at  low  frequencies. 

At  high  frequencies,  we  find  the  KF  equality  leads  to  the 
approximation 


1  jw/if 


)CIL 


CL 


/p 


(4.51) 


Thus  we  desire 


CL  »  I 


(4.52) 


which  leads  to 

L  -  /yC*  (CC1)  -  /pC'  (4.53) 

Therefore  at  both  high  and  low  frequencies  tying  the  singular  values 

together  requires  L  ■  /p£  .  we  only  have  to  iterate  on  the  scalar  y  to 
obtain  the  desired  crossover  characteristics  of  ai[Gp0I)( j  u) ) .  It 
was  found  that  for  y  ■  .01  the  singular  values  of  GyoL^3)  (Figure  4.8) 
exhibited  the  desired  characteristics  of  high  DC  gains  (60  dB  at  u  » 
.0001)  and  a  crossover  of  0.1  radian  per  second. 

Using  the  L  matrix  thus  generated  and  iterating  on  the  scalar  1//y, 
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the  FARE  ms  solved,  the  filter  gain  matrix,  H,  generated  and  the 
singular  values  of  the  KF  transfer  matrix  (o[Gj(p( ju) ] )  calculated. 

With  1//u  equal  to  1,  the  singular  values  of  Ggp(s)  were  found  to 
exactly  match  the  singular  values  of  GpoL<  a) •  Figure  4.9  shows  the 

singular  values  of  Ggp(s)  with  1//ST  -  1  and  h  -  .1C*. 

At  this  point,  the  poles  of  the  filter  (lj [ A-HC] )  were 
calculated.  All  had  negative  real  parts,  thus  verifying  the  guaranteed 
stability  of  the  filter.  Further,  the  robustness  of  the  filter  was 
checked  by  evaluating 

o.tl+G  (jw)]  (4.55) 

X  “*  "TvF 


ai(I+G^,(ju)).  (4.56) 

The  filter  robustness  requirements  discussed  earlier  were  met  as  both 
sets  of  singular  values  maintained  magnitudes  of  unity  or  greater. 

The  singular  value  loop  shapes  of  the  filter  are  now  recovered  for 
the  compensator.  The  CARE  is  solved  with  R  »  _I  and  the  result  used  to 
calculate  the  control  gain  matrix,  G.  The  singular  values  of  the 
resultant  loop  transfer  function  (o^(T(ju)])  are  generated  and 
compared  to  the  KF  singular  values.  Hie  designer  iterates  on  the  scalar 
q  (where  £  ■  qC'C  in  the  CARE)  until  a  satisfactory  match  is  obtained 
over  the  frequency  range  of  interest.  As  shown  in  Figure  4.10,  a  q  of 
100  yielded  satisfactory  results  with  a  crossover  at  approximately  .065 
radians  per  second  and  DC  gains  of  55  dB  (at  .0001).  (In  fact,  larger 
values  of  q  allowed  for  crossovers  and  DC  gains  more  closely  approaching 
the  KF  values  but  the  controller  gains  subsequently  generated  were  found 
to  saturate  the  sternplanes  and/or  cause  the  rate  limits  to  be 
exceeded . ) 
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Figura  4.9:  Singular  Valuaa  of  G^a) 
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Notice  the  very  narrow  spread  at  crossover  between  the  minimum  and 
maximum  singular  values.  Also,  at  frequencies  above  1.0  radians  per 
second,  the  roll-off  approaches  80  dB  per  decade.  Ibis  conforms  to  the 
Bode- Horowitz  condition  that  all  physical  systems  must  exhibit  at  least 
two  pole  roll-off.  This  roll-off  will  ensure  rapid  attenuation  of  high 
frequency  modeling  errors  and  sensor  noise.  Further,  the  roll-off  at 
crossover  as  predicted  by  Bode  is  approximately  20  dB  [7] .  The  presence 
of  a  non-minimus  phase  zero  at  0.488  has  not  prevented  the  LTR  from 
being  accomplished.  Its  presence  however,  might  possibly  have  caused 
the  delay  in  rolloff  exhibited  by  the  maximum  singular  value. 

The  robustness  of  the  overall  loop  transfer  matrix,  T(s),  can  now 
be  determined.  Figures  4.11  and  4.12  plot  the  singular  values  of  the 
return  difference  (Cj,[I  +  T(jiu)]  and  inverse  return  difference 
(Oil i  +  T~1(j(d)])  respectively.  Using  the  gain  and  phase  margins  as 
defined  in  Chapter  3,  we  find  for  additive  error 

GM  -  [-4.73  dB,  11.2  dB] 

PM  *  [-41.5  deg,  41.5  deg] 

For  multiplicative  errors  we  have 

GM  -  [minus  infinity,  6  dB] 

PM  -  [-60  deg,  60  deg] 

Thus,  the  overall  loop  transfer  matrix  is  quite  robust  and  therefore 
relatively  insensitive  to  modeling  errors  which  may  exist. 

The  compensator  gains  generated  (found  in  Table  C.4  of  Appendix  C) , 
will  now  be  used  in  the  linear  and  nonlinear  simulations  to  ascertain 
the  vehicle  response  to  various  reference  inputs  and  initial 
conditions.  The  controller  will  be  evaluated  in  terms  of  the 
time-domain  specifications  delineated  in  Chapter  3. 
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Flgura  4.12:  Singular  Valuaa  of  H*T‘1<3») 
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4.7  Compensated  System  Response 

4.7.1  Simulation 

Using  the  linearized  model  of  the  submarine  at  twenty  knots  (A,  C, 

and  C)  and  the  filter  and  control  gains  (H_ and  G)  designed  for  that 

model,  the  compensator  was  tested  via  a  computer  simulation.  The  true 
test  of  a  compensator  is  whether  it  adequately  controls  the  vehicle  and 
meets  the  specifications.  Given  that  there  is  no  actual  test  platform, 
the  alternative  is  a  simulation  which  incorporates  the  dynamics  of  the 
vehicle  (as  modeled  by  the  equations  of  motion)  and  the  compensator 
effects  including  any  augmentation.  Both  linear  and  nonlinear, 
simulations  were  developed,  solving  the  linearized  and  nonlinear 
equations  of  motion  respectively.  Thus,  one  may  ascertain  how  well  a 

linear  compensator  design  is  able  to  control  the  nonlinear  model  of  the 

vehicle  and  critically  compare  this  with  the  linear  model  response. 
Figure  4.5  illustrates  the  simulated,  closed-loop  system. 

The  simulation  allows  step  and  ramp  perturbations  to  be  input. 

Free  surface  effects,  random  noise  and  control  surface  rate  limits  were 
not  modeled.  Further  details  of  the  SUBMODEL  program  can  be  found  in 
reference  [18]. 

4.7.2  Initial  Conditions  and  Reference  Inputs 

When  the  depth  and  heading  controller  is  initially  activated,  it 
will  have  to  compensate  for  step  commands  as  the  ordered  depth  and 
heading  will  almost  certainly  be  different  from  the  depth  and  course  the 
vehicle  is  presently  maintaining.  During  manual  control  it  is  expected 
that  the  course  will  be  maintained  within  two  or  three  degrees  of  that 
ordered  and  the  depth  maintained  to  within  10  feet.  To  ensure  a 
practical  controller,  it  was  desired  that  the  compensator  be  capable  of 
withstanding  simultaneous  step  commands  of  10  degrees  and  30  feet. 
Additionally,  the  controller  was  tested  with  ramp  inputs  in  heading  and 
depth  to  ensure  it  could  be  utilized  to  automatically  change  the 
vehicle's  course  and  depth  over  greater  ranges.  Specifically,  the 
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compensated  system  was  subjected  to  a  ramp  course  change  of  30  degrees 
and  a  ramp  depth  change  of  50  feet,  both  input  over  100  seconds.  The 
ramp  inputs  were  imposed  separately. 


4.7.3  Error  Limits 

Through  repeated  testing,  it  was  found  that  error  limits 
(internally  limited  within  the  simulations)  of  10  degrees  in  heading  and 
10  feet  in  depth  offered  satisfactory  results  for  the  twenty  knot 
model.  These  error  limits  prevented  excessive  control  surface 
deflection  and  also  prevented  the  rate  limits  mentioned  in  Chapter  3 
from  being  exceeded. 

4.7.4  Linear  and  Nonlinear  Responses  to  Step  Inputs 

The  compensated  nonlinear  responses  to  simultaneous  step  commands 

of  10  degrees  and  30  feet  are  shown  in  the  plots  of  Figure  4.13.  The 
linear  and  nonlinear  state  responses  were  very  similar  with  the  major 
difference  between  the  two  being  that  the  linear  simulations  showed  less 
error  in  psi  and  z  at  the  end  of  the  run.  This  is  to  be  expected  as  the 
compensator  gains  were  designed  using  the  linear  model  of  the 
submarine.  The  errors  for  both  the  linear  and  nonlinear  simulations 
were  small  and  growing  smaller  as  time  progressed  due  to  the  integrator 
action. 

The  time  domain  specifications  for  the  compensator  are  easily  met 
whether  controlling  the  linear  or  nonlinear  model.  The  linear  model 
heading  error  was  less  than  ten  percent  (one  degree)  at  28  seconds  while 
the  depth  error  was  within  10  percent  (three  feet)  in  54  seconds.  The 
nonlinear  model  has  settling  times  of  71  and  78  seconds  respectively. 

The  settling  time  specification  at  20  knots  was  200  seconds. 

The  error  at  200  seconds  for  the  linear  model  was  0.8  percent  in 
heading  and  1.0  percent  in  depth  which  is  well  within  the  three  percent 
specification.  For  the  nonlinear  model,  the  errors  at  200  seconds  are 
2.245  and  1.1  percent  and  at  300  seconds  are  0.7  and  0.5  percent. 
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Flgura  4.13:  Stap  Raaponaa  of  tha  Twanty  Knot 
Coapanaatad  Nonllnaar  Modal 
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Flgura  4.13:  Step  Raaponu  of  tha  Twenty  Knot 
Coapanaatad  Nonlinaar  Modal 
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Initial  control  surface  deflections  were,  of  course,  the  same  for 
both  models  (same  gains  and  initial  errors).  The  maximum  rudder  angle 
is  4.5  degrees  at  seven  seconds  and  the  largest  sternplane  deflection  i3 
16.2  degrees  after  two  seconds.  Thus,  the  rate  limits  were  not  exceeded 
nor  were  the  control  surface  deflections  near  saturation  (40  degrees). 

Note  the  type  of  control  action  which  the  design  procedure  yields. 
One  finds  that  essentially  all  the  control  surface  movement  comes  in  the 
first  thirty  seconds.  This  is  due  to  the  fact  that  the  controller 
"believes"  it  "knows"  precisely  how  the  vehicle  will  response;  and  thus, 
it  gives  large  initial  control  actions  and  then  allows  the  vehicle 
dynamics  to  take  over  and  "carry"  the  vehicle  to  the  reference 
position.  Therefore,  we  see  rapid  initial  reductions  in  error  as  the 
vehicle  is  allowed  to  glide  to  the  desired  position.  Although  it  cannot 
be  seen  on  the  plots,  there  is  some  residual  control  deflection  tending 
to  take  the  vehicle  toward  zero  steady  state  error. 

4.7.5  Linear  and  Nonlinear  Ramp  Responses 

Linear  and  nonlinear  simulations  were  conducted  to  ascertain 
whether  the  controller  could  response  adequately  to  ramp  inputs  used  to 
turn  or  change  vehicle  depth.  A  30  degree  turn  was  first  conducted  with 
the  nonlinear  model  responses  for  psi,  z,  heading  error,  depth  error  and 
control  action  shorn  in  Figure  4.14.  The  linear  model  showed  the 
submersible  reaching  steady  state  at  60  seconds  after  the  ramp  input 
ceased  (160  seconds  simulation  time)  with  a  heading  error  of  0.33 
percent.  The  depth  excursion  was  essentially  zero.  In  the  nonlinear 
case  the  submarine  is  within  3  percent  (one  degree)  of  the  ordered  30 
degree  heading  100  seconds  after  the  ramp  input  ceased  and  was  still 
approaching  30  degrees  (29.7)  at  300  seconds.  The  maximum  depth 
excursion  if  3.3  feet  during  the  turn  and  is  within  0.35  feet  at  the  end 
of  the  simulation.  Thus  the  "level”  turn  specification  (15  feet  allowed 
at  20  knots)  was  met  by  the  controller  for  both  the  linear  and  nonlinear 
models.  Control  actions  were  well  behaved. 
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Figure  4.14:  Thirty  Dagraa  Ramp  Raaponaa  of  tha 
Coapanaatad  Nonlinaar  Modal 
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A  depth  change  of  SO  feet  was  also  simulated  with  excellent 
results.  Both  the  linear  and  nonlinear  simulations  showed  practically 
no  course  deviation  during  the  ramp  depth  change.  Hie  linear  response 
showed  the  vehicle  reaching  50  feet  some  60  seconds  after  the  input  with 
a  0.47  foot  overshoot  (one  percent)  and  a  0.3  percent  (and  decreasing) 
depth  error  at  300  seconds.  The  nonlinear  model  response  (Figure  4.15) 
shows  the  ordered  depth  being  reached  48  seconds  after  termination  of 
the  ramp  input  with  a  1.3  foot  overshoot  (2.6  pecent)  and  an  error  at 
300  seconds  of  0.7  percent  (and  decreasing).  Again,  the  control  design 
more  than  adequately  meets  the  specifications. 

Other  ramp  inputs  were  imposed  with  similar  results.  Hie 
compensator  thus  can  be  utilized  to  "drive”  the  vehicle  with  no  apparent 
magnitude  limits  in  depth  and  heading.  Further,  although  the  system  as 
modeled  has  only  one  integrator  per  channel,  the  errors  with  ramp  inputs 
have  still  tended  to  approach  zero. 


4.8  Chapter  Summary 

In  the  present  chapter,  the  LQG/LTR  methodology  was  presented  and 
used  with  the  frequency  domain  specifications  to  design  a  set  of  filter 
and  control  gains  for  the  augmented  system's  MBC  at  twenty  knots.  It 
was  found  that  a  NMP  zero  outside  the  compensator's  bandwidth  did  not 
adversely  affect  the  recovery  process. 

Dsing  both  a  linear  and  nonlinear  simulations  with  step  and  ramp 
commands,  the  MBC  was  successfully  tested  against  the  time  domain 
specifications  delineated  in  Chapter  3.  In  Chapter  5,  the  speed  range 
over  which  the  twenty  knot  MBC  meets  the  specifications  shall  be 
investigated  and  other  linear  models  generated  in  order  to  accomplish 
gain  scheduling  over  the  submarine's  operational  speed  range. 
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Flgur*  4. IS:  Fifty  Foot  Ramp  Raaponsa  of  tha 
Companaatad  Nonllnaar  Modal 
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5.  GAIN  SCHEDULING 


5.1  Introduction 

In  this  chapter  we  shall  first  investigate  the  speed  range  over 
which  the  control  and  filter  gains  derived  from  the  twenty  knot  linear 
model,  meet  the  specifications  for  the  previously  discussed  ramp  and 
step  inputs.  In  the  following  sections  the  five  and  ten  knot  models  are 
presented  along  with  their  corresponding  filter  and  control  gains.  The 
speed  range  of  each  set  of  these  compensator  gains  is  also 
investigated.  Finally,  a  gain  scheduling  scheme  is  offered  that 
adequately  controls  the  submarine  over  the  intended  five  to  30  knot 
speed  range. 

5.2  Twenty  Knot  Compensation 

5.2.1  Range  of  the  Twenty  Knot  Controller 

Using  the  nonlinear  computer  simulation  with  the  propulsion  and 
initial  condition  data  modified  as  necessary  to  reflect  the  desired 
vehicle  speed,  one  is  able  to  ascertain  the  speed  range  over  which  the 
twenty  knot  model-based  compensator  (MBC)  adequately  controls  the 
submarine.  It  was  found  that  the  twenty  knot  control  gains,  met  or 
bettered  specifications  over  a  speed  range  from  15  knots  to  30  knots. 

The  nonlinear  time  responses  at  15  and  30  knots  are  discussed  below. 

5.2.2  Vehicle  Response  at  Fifteen  Knots  Using  Twenty  Knot  Gains 

The  nonlinear  time  responses  of  psi,  z,  heading  error,  depth  error 
and  control  action  for  simultaneous  step  inputs  of  30  feet  and  10 
degrees  are  shown  in  the  plots  of  Figure  5.1.  The  time  domain 
specifications  are  satisfied.  The  nonlinear  model  heading  error  is  less 
than  ten  percent  (one  degree)  at  80  seconds  while  the  depth  error  is 
within  10  percent  (three  feet)  in  149  seconds.  The  specification  at  15 
knots  is  250  seconds.  The  error  at  250  seconds  is  0.54  percent  in 
heading  and  0.025  percent  in  depth  which  is  well  within  the  three 


84 


Figure  3.1:  Coapsnaatad  Nonlinear  Step  Response 
•t  13  Knots  with  20  Knot  Gains 
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percent  specification.  At  300  seconds  (the  end  of  the  simulation)  the 
heading  error  was  0.027  degrees  (0.27  percent)  with  the  depth  error  at 
0.17  feet  (0.57  percent). 

Initial  control  surface  deflections  are  the  same  as  in  the  twenty 
knot  case  due  to  the  fact  that  the  gains  and  errors  are  the  same, 
initially.  The  maximum  rudder  angle  is  4.5  degrees  at  seven  seconds  and 
the  largest  sternplane  deflection  is  16.2  after  two  seconds.  Thus, 
neither  were  the  rate  limits  exceeded  nor  were  the  control  surface 
deflections  near  saturation  (40  degrees). 

Simulations  were  conducted  to  ascertain  whether  the  controller 
could  respond  adequately  to  ramp  inputs  at  15  knots.  A  30  degree  turn 
was  conducted  with  the  nonlinear  model  response  shown  in  Figure  5.2. 

The  plots  show  the  submarine  reaching  29  degrees  47  seconds  after  the 
ramp  input  ceased  (147  seconds  simulation  time)  and  still  approaching  30 
degrees  (29.7)  at  300  seconds.  The  maximum  depth  excursion  is  2.93  feet 
during  the  turn  and  is  within  0.11  feet  (and  decreasing)  at  end  of  the 
simulation.  Thus,  the  "level"  turn  specification  (15  feet  allowed  at  15 
knots)  was  met  by  the  controller. 

A  depth  change  of  50  feet  at  15  knots  was  also  simulated  with 
excellent  results.  As  before,  the  simulations  show  (Figure  5.3) 
practically  no  course  deviation  during  the  ramp  depth  change.  The 
nonlinear  model  response  shows  the  commanded  depth  being  reached  in  145 
seconds  after  termination  of  the  ramp  input  with  a  0.3  foot  overshoot 
(0.6  percent).  Again,  the  control  design  more  than  adequately  meets  the 
specifications . 

Thus,  the  compensator  designed  for  a  vehicle  linearized  about 
straight  ahead  motion  at  twenty  knots  adequately  controls  the 
submersible  and  easily  meets  the  time  domain  specifications  at  15 
knots.  In  the  following  section,  the  results  for  a  vehicle  speed  of  30 
knots  are  presented. 


5.2.3  Vehicle  Response  at  Thirty  Knots  using  Twenty  Knot  Gains 

The  nonlinear  time  response  for  simultaneous  step  inputs  of  30  feet 
and  10  degrees  is  shown  in  the  plots  of  Figure  5.4.  The  time  domain 
specification  (100  seconds  settling  time  at  30  knots)  is  satisfied  with 
the  nonlinear  heading  error  being  less  than  one  degree  at  17  seconds  and 
the  depth  error  within  10  percent  (three  feet)  in  46  seconds.  At  300 
seconds  (the  end  of  the  simulation)  the  heading  error  was  0.093  degrees 
(0.93  percent)  with  the  depth  error  at  0.32  feet  (1.07  percent),  in 
both  cases  the  error  is  tending  toward  zero. 

There  are  small  overshoots  in  both  heading  and  depth  responses  at 
30  knots  using  20  knot  gains.  This  is  to  be  expected,  since,  at  higher 
speeds,  the  vehicle  responds  more  quickly  to  a  given  control  surface 
deflection.  The  overshoots  were  0.66  degrees  in  yaw  and  2.82  feet  in 
depth. 

A  30  degree  turn  was  conducted  with  the  nonlinear  model  responses 
shown  in  Figure  5.5.  The  plots  show  the  submarine  reaching  29  degrees 
80  seconds  after  the  ramp  input  ceased  with  a  vehicle  heading  of  29.8 
degrees  at  300  seconds.  The  maximum  depth  excursion  is  4.7  feet  during 
the  turn  and  is  within  0.5  feet  (and  decreasing)  at  end  of  the 
simulation.  Thus,  the  "level"  turn  specification  (20  feet  allowed  at  30 
knots)  was  met  by  the  controller. 

A  depth  change  of  50  feet  at  30  knots  (see  Figure  5.6)  was 
simulated  with  essentially  no  course  deviation  observed  during  the  ramp 
depth  change.  The  nonlinear  model  response  shows  the  ordered  depth 
being  reached  in  21  seconds  after  termination  of  the  ramp  input  with  a 
1.2  foot  overshoot  (2.4  percent)  and  an  error  at  300  seconds  of  0.01 
percent.  Again  the  control  design  more  than  adequately  meets  the 
specifications. 

Thus,  the  compensator  designed  for  a  vehicle  linearized  about 
straight  ahead  motion  at  twenty  knots  adequately  controls  the 
submersible  at  thirty  knots.  In  the  following  section,  the  ten  knot 
linear  model  is  briefly  discussed  along  with  its  control  gains  and 
applicable  speed  range. 
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5.3  Ten  Knot  Linear  Model 

The  nonlinear  equations  of  motion  were  linearized  about  straight 
ahead  motion  at  ten  knots  with  the  resultant  A  and  13  matrices  as  shown 
in  Appendix  D.  The  linear  model  wets  verified  through  a  modal  analysis 
and  a  comparison  of  linear  and  nonlinear  responses  to  comparable 
perturbations.  The  open-loop  plant  contained  a  NMP  zero  at  +0.241  and 
two  poles  at  the  origin.  The  open-loop  poles  and  multivariable  zeros 
are  also  shown  in  Appendix  0.  The  plant  open-loop  singular  values 
(C(sl-A) B] )  are  as  plotted  in  Figure  5.7.  The  singular  value 
corresponding  to  depth  has  a  crossover  frequency  of  0.51  radians  per 
second  while  the  singular  value  associated  with  heading  angle  has  a 
crossover  at  0.063  radians  per  second.  The  lower  crossover  frequencies 
in  comparison  with  the  twenty  knot  model  emphasize  the  fact  that  as  the 
vehicle  slows,  so  does  its  speed  of  response. 

This  model  was  also  augmented  with  the  break  frequency  being  0. 1 
radians  per  second.  This  increased  the  order  of  the  plant  to  twelve 
states  and  added  two  poles  at  -0. 1 .  The  singular  values  for  this 
augmented  plant  cross  over  at  0.295  (depth)  and  0.059  (heading)  radians 
per  second.  Note  the  maximum  singular  value  has  the  NMP  zero  within  its 
bandwidth. 

In  designing  the  controller,  the  L  matrix  (L*. 1£' )  was  selected  so 
that  both  singular  values  crossover  at  0.1  radians  per  second.  Thus, 
the  NMP  zero  will  be  outside  the  bandwidth  of  the  compensated  system. 

The  LTR  methodology  was  followed  (1//]T  -  1  and  q  ■  300)  with  the 
singular  values  of  the  overall  loop  transfer  matrix,  T(s),  (which 
includes  the  nominal  plant,  augmentation  and  model-based  compensator) 
shown  in  Figure  5.8.  Note  that  both  singular  values  crossover  at 
approximately  0.052  radians  per  second. 

The  eigenvalues  of  the  compensator  (K£Qg(s)  »  £( 3I-A+BG+HC) “ 1 H ) 
were  calculated  and  all  were  found  to  have  negative  real  parts,  as 
expected.  Thus  the  stability  of  the  Model-Based  Compensator  was 
verified.  The  multivariable  phase  (PM)  and  gain  margins  (GM)  of  the 
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Figure  3.7:  Singular  Valuaa  of  tho  Ton  Knot 
Opart -Loop  Plant 
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compensated  system  were  calculated,  and  found  to  be,  for  additive  error 

cat  -  [-4.48  dB,  9.75  dB] 

PM  -  [-39.4  deg,  39.4  deg] 
for  multipliative  error: 


GM  -  [-infinity,  6  dB] 

PM  -  [-60  deg,  60  deg]. 

Hie  control  and  filter  gains  of  the  ten  knot  controller  are  shown  in 
Appendix  D.  With  these  gains,  at  speeds  less  than  fifteen  knots,  the 
error  limits  imposed  within  the  simulation  in  order  to  avoid  control 
surface  saturation  were  four  feet  and  five  degrees. 

It  was  found  that  the  ten  knot  control  gains  met  or  bettered 
specifications  over  a  speed  range  from  8  knots  to  15  knots.  Thus,  the 
compensator  designed  for  a  vehicle  linearized  about  straight  ahead 
motion  at  ten  knots  adequately  controls  the  submersible  and  meets  the 
time  domain  specifications  from  8  to  15  knots.  In  the  following 
section,  the  five  knot  linear  model  is  discussed. 

5.4  Five  Knot  Linear  Model 

A  linear  model  was  generated  at  five  knots  for  straight  ahead 
motion  and  a  compensator  was  designed  based  on  this  model.  The 
open-loop  plant  contained  a  NMP  zero  at  +0.115.  The  plant  open-loop 
singular  values  are  as  shown  in  Figure  5.9.  The  crossovers  of  the 
singular  values  corresponding  to  psi  and  depth  are  0.032  and  0.26 
radians  per  second  respectively.  The  plant  was  then  augmented  with  lag 
compensation  at  0.1  radians  per  second  which  altered  the  crossover 
frequencies  to  0.032  and  0.19.  The  NMP  zero  is  within  the  system 
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bandwith.  Augmentation  was  considered  at  lower  frequencies  (0.05); 
however,  this  caused  the  crossover  frequencies  to  be  further  reduced  in 
the  compensated  plant,  for  gains  which  did  not  saturate  the  controls 
(low  values  of  the  scalar  parameter,  q). 

A  compensator  was  designed  to  match  a  crossover  frequency  of  0.1 
radians  per  second.  Designing  for  a  crossover  at  0.1  radians  per 
second,  instead  of  around  0.03,  was  an  attempt  to  increase  the  bandwidth 
of  the  controller  (and  hence,  the  speed  of  response)  and  to  increase  the 
DC  gains  (reducing  the  level  of  steady  state  error) .  The  singular 

values  of  the  overall  loop  transfer  matrix,  T(s) ,  for  this  design  (1//u 
-  1  and  q  »  100)  are  displayed  in  Figure  5.10. 

Even  though  the  filter  transfer  function  singular  values  crossover 
at  0.1  radians  per  second,  in  the  recovery  process  the  crossover 
frequencies  of  the  overall  transfer  matrix  attained  for  reasonable  gains 
(that  is  gains  that  did  not  saturate  the  controls)  are  0.032  radians  per 
second  and  for  psi  and  0.036  for  depth.  Thus,  the  system's  natural 
bandwidth  appears  to  limit  the  amount  of  performance  and/or  recovery 
that  may  reasonably  be  attained.  This  was  also  true  in  the  ten  knot 
design.  The  end  result  of  designing  the  filter  at  a  higher  crossover 
frequency  (0.1  radians  per  second)  is  that  the  filter  poles  are  slightly 
faster  than  necessary  as  compared  to  the  controller  eigenvalues. 

The  PM  and  GM  for  this  controller  assuming  additive  error  are 

(91  -  [-4  dB,  7.95  dB] 

PM  -  [-34.9  deg,  34.9  deg) 
while  for  multiplicative  error  they  are 


GM  -  (-  infinity,  6  dBl 


The  five  knot  linear  model  (A,  B,  C),  eigenvalues  and  transmission 
zeros,  and  control  and  filter  gains  are  found  in  Appendix  E. 

By  using  the  five  knot  gains,  in  the  simulation,  at  various  speeds 
it  was  shown  that  the  five  knot  compensator  gains  met  the  time  domain 
specifications  over  the  speed  range  of  five  to  seven  knots.  In  the  next 
section  a  gain  scheduling  scheme  is  discussed  and  tested. 

5.5  Gain  Scheduling  Algorithm 

From  previous  discussions  it  is  clear  that  for  the  system  under 
consideration,  the  LQG/LTR  methodology  generates  robust  controllers  that 
are,  in  general,  adequate  far  from  their  nominal  design  points  in  state 
space,  with  just  three  linear  models  (at  five,  ten  and  twenty  knots)  it 
has  been  shown  that,  except  for  the  interval  from  seven  to  eight  knots, 
the  resultant  compensator  gains  adequately  control  the  submersible  over 
its  entire  speed  range.  (Between  seven  and  eight  knots  the  response  is 
stable  but  too  slow  if  the  ten  knot  gains  are  used  and  too  oscillatory 
with  the  five  knot  compensation). 

Unfortunately,  using  just  these  three  sets  of  gains  and  linear 
models  leads  to  a  problem  incurred  when  shifting  from  one  set  of  gains 
to  another  due  to  the  discontinuities  at  these  shift  points.  This  type 
of  gain  scheduling  would  cause  large  control  surface  deflections  when 
none  are  warranted  as  a  gain  shift  is,  in  effect,  a  step  perturbation. 

In  order  to  avoid  these  discontinuities,  it  was  decided  to  attempt  a 
linear  interpolation  scheme  between  the  five  and  ten  knot  models;  and 
then,  between  the  ten  and  twenty  knot  points.  Above  twenty  knots,  the 
twenty  knot  model  and  gains  are  utilized.  For  instance,  if  the 
commanded  submarine  speed  is  seven  knots,  the  control  gain  (G) ,  filter 
gain  (II)  and  A  matrices  (the  _B  and  C  matrices  are  the  same  at  all 
speeds)  used  in  the  MBC  would  be  interpolated  at  two  fifths  of  the 
difference  between  the  respective  matrices  at  ten  and  five  knots  plus, 
the  five  knot  matrices.  It  is  these  interpolated  (3,  II  and  A  matrices 
that  are  entered  in  the  simulation. 
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The  simulation  has  not  evolved  to  the  point  where  gain  scheduling 
can  be  incorporated  on  a  real-time  basis.  However,  the  interpolated 
matrices  for  any  speed  can  be  generated  offline  and  tested  point  by 
point.  This  was  the  method  used  to  verify  the  gain  scheduling  scheme 
discussed  above. 

The  linear  interpolation  algorithm  was  used  to  generate  MBC's  at 
six,  seven,  eight,  nine,  twelve,  fifteen  and  eighteen  knots.  Results 
for  seven  and  fifteen  knots  are  discussed  below.  The  error  limits  for 
speeds  less  than  fifteen  knots  were  four  feet  and  five  degrees  while  at 
fifteen  knots  and  above  the  error  limits  were  10  feet  and  10  degrees. 

5.5.1  Selected  Gain  Scheduling  Results 

The  nonlinear  time  response  at  seven  knots  for  simultaneous  step 
inputs  of  30  feet  and  10  degrees  is  shown  in  the  plots  of  Figure  5.11. 
The  time  domain  specifications  are  satisfied  with  the  nonlinear  model 
heading  error  being  less  than  ten  percent  (one  degree)  at  100  seconds 
and  the  depth  error  within  10  percent  (three  feet)  in  244  seconds.  The 
specification  at  seven  knots  is  360  seconds.  At  600  seconds  (the  end  of 
the  simulation)  the  heading  error  is  0.096  degrees  (0.96  percent)  with  a 
depth  error  of  0.0039  feet  (0.013  percent).  Both  errors  are  slowly 
approaching  zero. 

Control  surface  deflections  are  within  the  specified  rate  and 
travel  limits.  The  maximum  rudder  angle  is  7.5  degrees  at  twelve 
seconds  and  the  largest  sternplane  deflection  is  24.4  degrees  after  four 
seconds. 

A  30  degree  turn  was  conducted  with  the  nonlinear  model  responses 
shown  in  Figure  5. 1 2.  The  plots  show  the  submarine  reaching  29  degrees 
300  seconds  after  the  ramp  input  ceased  and  still  approaching  30  degrees 
(29.6)  at  600  seconds.  The  maximum  depth  excursion  is  0.12  feet  during 
the  turn.  Thus,  the  "level"  turn  specification  (10  feet  allowed)  was 
met  by  the  controller. 


Figure  3.12:  Scheduled  Nonllneer  30  Degree  Reep 
Response  st  Seven  Knots 
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A  depth  change  of  50  feet  at  seven  knots  was  also  simulated  as 
shown  in  Figure  5.13.  The  nonlinear  model  response  shows  the  ordered 
depth  being  reached  350  seconds  after  termination  of  the  ramp  input  with 
a  0.13  foot  overshoot  (0.26  percent).  Again  the  control  design  more 
than  adequately  meets  the  specification. 

Thus,  the  compensation  derived  from  a  linear  interpolation  between 
the  five  and  ten  knot  gains  and  models  adequately  controls  the 
submersible  and  meets  the  time  domain  specifications  at  seven  knots. 
Additionally,  the  phase  and  gain  margins  were  calculated,  with  the 
interpolated  seven  knot  gains  and  model,  for  additive  error  we  have 

GM  -  [-4.26  dB,  8.69  dB] 

PM  -  [-36.9  deg,  36.9  deg]. 

For  multiplicative  error,  the  multivariable  margins  are 

04  ■  [-infinity,  6  dB] 

PM  ■  [-60  deg,  60  deg] , 

The  results  for  a  vehicle  speed  of  15  knots  are  now  presented. 

The  time  response  at  fifteen  knots  for  simultaneous  step  inputs  of 
30  feet  and  10  degrees  is  shown  in  the  plots  of  Figure  5.14.  The  time 
domain  specification  (220  seconds  settling  time)  is  satisfied  with  the 
nonlinear  model  heading  error  being  less  than  ten  percent  (one  degree) 
at  82  seconds  while  the  depth  error  is  within  10  percent  (three  feet)  in 
100  seconds.  At  400  seconds  (the  end  of  the  simulation)  the  heading 
error  was  0.064  degrees  (0.64  percent)  with  the  depth  error  at  0.44  feet 
(1.46  percent).  In  both  cases  the  error  is  tending  toward  zero. 


Schadulad  Nonlinaar  Stap  Raaponaa  at 
Fiffcaan  Knota 


The  30  degree  turn  was  simulated  with  the  nonlinear  model  responses 
shown  in  Figure  5.15.  The  submarine  reaches  29  degrees  160  seconds 
after  the  ramp  input  ceased  and  the  vehicle  heading  is  29.7  degrees  at 
400  seconds.  The  maximum  depth  excursion  is  2.3  feet  during  the  turn 
and  is  within  0.13  feet  of  the  reference,  and  decreasing,  at  the  end  of 
the  simulation.  The  "level"  turn  specification  (15  feet  allowed)  was 
met  by  the  controller. 

As  displayed  in  Figure  5.16,  a  depth  change  of  50  feet  at  15  knots 
was  simulated.  The  nonlinear  model  response  shows  the  commanded  depth 
being  reached  60  seconds  after  termination  of  the  ramp  input  with  a  2.7 
foot  overshoot  (5.4  percent)  and  an  error  at  400  seconds  of  1.34  percent 
(0.67  feet)  and  declining.  Again,  the  control  design  more  than 
adequately  meets  the  specifications. 

Thus,  the  15  knot  MBC  derived  from  a  linear  interpolation  between 
the  ten  and  twenty  knot  models  adequately  controls  the  submersible.  The 
multi varibale  margins  assuming  additive  error  were  found  to  be 

PM  -  [-4.64  dB,  10.64  dB] 

GM  »  [-41.4  deg,  41.4  deg). 

For  multiplicative  errors  the  margins  are 

PM  •-*  [-infinity,  6  dB] 

GM  ■  [-60  deg,  60  deg]. 

Further,  the  interpolated  gains  were  found  to  meet  or  better  the 
specifications  at  all  speeds  tested. 


5.6  Chapter  Summary 

It  has  been  shown  that  a  linear  interpolation,  gain  scheduling 
scheme  provides  satisfactory  control  of  the  submerged  vehicle  from  five 
to  twenty  knots.  At  twenty  knots  and  above,  the  twenty  knot  MBC  yields 
excellent  results.  Thus,  the  three  linear  models  and  their  associated 
compensations  have  adequately  served  as  the  basis  for  control  of  the 
vehicle  over  its  operating  range  in  speed.  Also,  we  remark  here  that 
faster,  as  well  as  larger,  ramp  inputs  can  be  tolerated  making  the 
controllers  presented  here  even  more  practical. 
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6.  SUMMARY,  CONCLUSIONS  AND  RECOMMENDATIONS 


6.1  Summary 

This  thesis  presented  a  multivariable  control  design  example  for  an 
underwater  vehicle  which  comprised  of  the  following: 

1.  Vehicle  modeling  based  on  the  NSRD C  2510  equations  including 
crossflow  drag  and  vortex  shedding  terms.  These  equations 
were  linearized  to  generate  the  linear  model  of  the  submarine 
which  was  then  analyzed  and  verified. 

2.  Frequency  and  time  domain  specifications  were  then  developed 
against  which  a  controller  could  be  designed  and  tested. 
Multivariable  robustness  issues  were  also  discussed. 

3.  The  Model-Based  Compensator  structure  was  presented  and 
appropriate  loop  shaping  (lag  augmentation)  included  in  the 
compensator  structure.  1)16  Linear  Qiadratic  Gaussian/Loop 
Transfer  Recover  (LQG/LTR)  methodology  for  multivariable 
control  design  was  discussed  and  an  example  of  the  frequency 
domain  based  design  process  was  given  for  the  vehicle  model  at 
twenty  knots.  The  controller  robustness  in  terms  of 
multivariable  phase  and  gain  margins  was  evaluated  and,  using 
a  nonlinear  simulation,  the  compensator  was  tested.  The 
compensator  was  subjected  to  step  and  ramp  inputs  and  its 
response  evaluated  using  the  time  domain  specifications. 

4.  Hie  speed  range  over  which  the  twenty  knot  model  and  control 
gains  met  the  performance  specifications  was  then 
investigated.  Linear  models  at  five  and  ten  knots  were 
discussed  and  used  as  a  basis  for  generating  two  additional 
sets  of  compensator  gains.  Using  the  three  linear  models  and 
their  respective  control  gains  a  gain  scheduling  scheme  was 
presented  and  tested  which  allowed  for  good  automatic  heading 
and  depth  control  of  the  submersible  over  its  operational 
speed  range. 
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6.2  Conclusions 

For  the  type  of  control  design  desired,  namely,  an  automatic 
heading  and  depth  control,  linearizing  about  straight  ahead  motion  at 
constant  speed  incorporated  enough  of  the  essential  vehicle  dynamics  so 
as  to  yield  a  model  which  was  adequate  for  compensator  design.  The 
LQG/LTR  design  methodology  offered  a  systematic  method  for  multivariable 
control  design  which  generated  robust  controllers  that  were  not  only 
stable  but  provided  satisfactory  control  far  from  their  nominal  point 
in  state  space.  Further,  the  method  allowed  recovery  of  the  desired 
singular  value  loop  shapes  in  the  presence  of  NMP  zeros  which  were 
outside  the  bandwidth  of  the  compensator.  However,  the  maximum 
bandwidth  of  the  compensated  system  appears  to  be  constrained  by  the 
plant's  natural  open-loop  bandwidth.  This  is  an  advantageous  property 
of  the  LTR  process  as  it  disallows  compensator  designs  that 
mathematically  enhance  the  system  bandwidth  but  prove  useless  in 
practice. 

6.3  Recommendations  for  Further  Study 

Incorporating  differential  control  on  the  sternplanes  (or  using  a 
different  control  surface  configuration  such  as  the  inverted-V)  should 
be  investigated.  A  control  system  of  three  inputs  (rudder,  and 
differential  sternplanes)  and  three  outputs  (heading,  depth  and  roll) 
could  be  designed  which  would  reduce  the  coupling  effects  between  planes 
of  motion  by  allowing  direct  control  over  the  vehicle  roll  orientation. 
Ihis  would  assist  in  further  overcoming  the  strong  tendency  of  the 
vehicle  to  dive  while  turning. 

As  the  controller  design  and  model  requirements  are  strongly 
dependent  upon  the  function  a  control  system  is  expected  to  serve,  one 
could  linearize  the  equations  of  motion  about  small  control  surface 
deflections  in  order  to  more  fully  capture  the  true  vehicle  dynamics  in 
the  linear  model.  This  might,  however,  require  more  models  and  a  more 
complex  gain  scheduling  technique  to  adequately  control  the  vehicle  over 
its  speed  range. 
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Incorporating  free  surface  effects  (wave  action)  in  the  simulation 
would  provide  a  more  realistic  model  of  the  environment  near  the  ocean 
surface.  This,  in  the  addition  to  gain  scheduling  within  the 
simulation,  would  enable  one  to  test  the  control  design  more  completely 
in  determining  its  practicality. 

The  type  of  control  surface  action  which  the  LQG/LTR  methodology 
produced  is  an  interesting  area  for  a  designer's  consideration.  The 
vast  majority  of  control  movement  is  developed  in  the  first  ten  to 
thirty  seconds;  and  thus,  yields  large,  rapid  deflections.  This  large, 
rapid  control  action  associated  with  the  present  design  is  due  to  the 
quadratic  cost  functional  used  in  the  linear  quadratic  control  design. 
Incorporated  within  the  functional  is  the  control  weighting  matrix  R, 
which  penalizes  any  control  action;  and  thus,  by  varying  the  diagonal 
entries  of  R,  slower,  less  severe  control  action  may  be  generated,  if 
desired. 

Finally,  it  would  be  advantageous  to  develop  an  estimate  of  the 
modeling  errors.  This  would  allow  a  more  revealing  and  realistic 
measure  of  robustness  than  the  multivariable  phase  and  gain  margins  used 
in  this  thesis.  The  need  for  modifying  the  controllers  may  be 
identified,  based  on  the  modeling  error  information  and  the  robustness 
criterion  presented  in  Chapter  3. 
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PARAMETRIC  LINEARIZATION 
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III.  normal  Force  (Cont. ) 
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Jt*. 


O  to 


Rolling  Torque  (Cont. ) 
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IV.  Rolling  Torque  (Cont.) 
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V.  Pitching  Torque 
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V.  Pitching  Torque  (Cont. ) 
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APPENDIX  C 


The  SUBMODEL  program  as  detailed  in  reference  [18]  was  developed 
at  Draper  Laboratory  to  perform  any  of  the  following  tasks: 

1.  Solve  the  previously  developed  nonlinear  differential 
equations  of  motion  of  a  submarine. 

2.  Search  for  a  local  equilibrium  point  in  the  nonlinear 
equations  of  motion  by  finding  a  set  of  state  variable  values 
for  which  the  derivatives  are  essentially  zero. 

3.  Calculate  the  linearized  dynamics  about  a  particular  nominal 
point  using  the  previously  developed  linearized  equations. 

4.  Solve  the  linearized  equations  of  motion  for  the  submarine. 

5.  Simulate,  using  either  the  linear  or  nonlinear  equations,  the 
compensated  vehicle  response. 

The  program,  as  originally  implemented  was  designed  to  handle 
nonlinear  equations  of  the  form 

*1  i  *  u) 


where 

»  10x1  state  vector 
ii  «  4x1  control  vector 

f_  “  10x1  vector  that  is  the  nonlinear  functions  of  the  states 
and  controls 

M  «  10x10  matrix  of  hydrodynamic  coefficient 

The  first  nine  states  are  u  (forward  velocity),  v,  w,  p,  q,  r, 
phi  ((9),  theta  (9),  and  psi  (<ji).  The  tenth  differential  equation  and 
state  variable  is  used  to  describe  the  propulsion  dynamics.  The  four 
controls  originally  incorporated  in  SUBMODEL  were  6s  (sternplane 
deflection),  6b  (bowplane  deflection),  6r  (rudder  deflection),  and 
WSTEAM  (steam  flow). 
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For  purposes  of  this  thesis ,  the  SUBMODEL  Program  was  modified  for 
the  following  reasons.  The  present  operating  procedures  are  such  that 
the  propulsion  plant  is  controlled  from  within  the  engine  room  of  the 
submarine.  The  engineers  maintain  the  ordered  propeller  speed 
regardless  of  the  maneuver  the  submarine  is  presently  undertaking. 
Additionally,  as  discussed  previously,  the  fairwater  planes  are  placed 
in  a  fixed  position  and  not  utilized  under  normal  operating  conditions. 
(It  should  be  noted  that  by  not  utilizing  the  fairwater  planes  under 
normal  conditions,  a  separate  set  of  gains  can,  alternatively,  be 
generated  as  a  method  of  backup  control  of  vehicle  depth.)  Further,  it 
is  the  intent  of  this  thesis  to  use  and  evaluate  the  loop  transfer 
recovery  technique  (discussed  in  Chapter  4)  to  design  the  compensator. 
This  methodology  requires  a  square  system  with  equal  control  inputs  (u), 
and  observed  outputs,  v.  Finally,  the  controller  to  be  designed  is  one 
that  will  control  the  heading  and  depth  of  the  submarine. 

Due  to  these  requirements  and  considerations  a  modification  to  the 
SUBMODEL  program  was  developed.  CONSTRPS  is  a  computer  program  which 
will  accomplish  the  same  five  tasks  as  outlined  previoulsy,  but  the 
shaft  speed  is  assumed  constant  and  the  number  of  controls  and  outputs 
earn  be  varied.  The  above  considerations  led  to  the  adoption  of  a  two  by 
two  system  with  the  two  controls  being  the  rudder  and  the  sternplanes 
and  the  outputs,  psi  and  z.  The  propulsion  variable,  with  constant 
shaft  speed  becomes  a  function  of  the  forward  velocity  and  therefore,  is 
incorporated  in  the  u  state  variable.  To  summarize: 


phi 

theta 

psi 


z 
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Before  the  linearized  dynamics  can  be  calculated,  equations  of 
motion  solved,  or  the  local  equilibrium  point  search  for,  the  program 
must  be  supplied  the  mass  properties,  hydrodynamic  coefficients,  and  the 
propulsion  and  drag  constants.  The  constants  and  coefficients  describe 
the  dynamics  of  a  specific  vehicle;  and,  with  two  exceptions,  are 
assumed  to  be  valid  for  any  dynamic  condition.  The  exceptions  are  the 
propulsion  variables,  wake  and  thrust  deduction  which  must  be  included 
in  the  propulsion  data  provided  to  the  program.  Within  the  SUBMODEL  and 
CONSTRPS  program  there  are  two  different  propulsion  models.  The  RPS 
propulsion  model  calculates  these  variables  while  in  the  ETA  propulsion 
model  these  two  variables  are  assumed  constant. 

The  RPS  propulsion  model  contains  a  first  order  differential 
equation  in  terms  of  rps  (revolutions  per  second)  of  the  propellor  and 
differential  equation  in  terms  of  eta  (eta  being  defined  as  ut/U).  It 
is  a  simplified  version  of  the  RPS  model  and  is  the  propulsion  model 
that  was  linearized  and  included  in  the  linear  equations  of  motion. 

Thus,  a  method  of  determining  accurate  wake  and  thrust  deduction  factors 
is  to  solve  the  nonlinear  equations  of  motion  using  the  RPS  model  and 
use  the  values  of  wake  and  thrust  deduction  calculated  after  the 
transients  have  settled  out. 

At  this  point  a  nominal  point  can  be  found  by  integrating  the 
nonlinear  equations  of  motion  (using  the  ETA  propulsion  model  with  the 
wake  and  thrust  deduction  found  above)  and  using  a  set  of  search 
routines.  To  integrate  the  nonlinear  equations  of  motion,  initial 
conditions  of  the  states  and  controls  must  be  supplied.  The  program 
solves  the  nonlinear  equations  using  a  fourth  order  Runge  Kutta 
routine.  Additionally,  the  initial  and  final  times  and  the  integration 
time  step  must  be  specified. 

The  search  routines  take  a  supplied  guess  (provided  by  the 
integration  of  the  nonlinear  equations  using  the  ETA  propulsion  model) 
and  iterate  a  specified  number  of  times  in  search  of  a  nominal  point. 

The  routines  iterate  by  perturbing  the  state  variables  in  attempting  to 


find  a  combination  that  sets  the  derivatives  of  the  states  equal  to 
zero.  The  closeness  of  a  point  to  being  a  local  equilibrium  point  is 
determined  by  how  close  the  sum  of  the  squares  of  the  derivatives  is  to 
zero. 

Once  the  nominal  point  is  found,  the  linearized  dynamics  of  the 

form 


X  ■  M  1  Ax  +  M  1  Bu 

(where  x  and  vj  are  the  perturbations  from  the  nominal  values  of  the 
state  and  the  controls)  can  be  calculated  by  linearizing  about  the 
nominal  point.  The  A  and  IB  matrices  are  calculated  and  placed  in  a  file 
for  use  in  later  designing  a  compensator.  Further,  if  one  desired  to 
ascertain  the  linear  dynamics  by  solving  the  linearized  differential 
equations,  the  initial  conditions  of  the  state  and  controls  must  be 
provided  as  well  as  the  nominal  point.  The  perturbations  from  the 
nominal  point  are  then  calculated  and  the  linear  dynamics  generated.  As 
with  the  nonlinear  equations,  the  user  must  specify  the  initial  time, 
final  time,  and  integration  time  step.  Also,  the  options  to  store  data 
for  plotting  and  to  print  out  the  state  and  control  responses  must  be 
delineated. 
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Table  C.l:  Twenty  Knot  Accelerations  and  Equilibrium  States 


XDOTC  1)  -  -.766276E-Z0 
XDOTC  2)  a  0.18S52SE-11 
XDOTC  3)  ■  0.949660E-19 
XDOTC  4)  a  -.22S747E-11 
XDOTC  5)  *  0.651512E-19 
XDOTC  4)  ■  0.364509E-14 
XDOTC  7 1  «  0.770974E-19 
XDOTC  «)  ■  134837E-2Z 


U  ■  0.333301E+02 
V  *  0.573749E-14 
N  «  -.585469E-17 
P  *  0.  770974E-19 
0  >  -.366668E-20 
R  *  -.343823E-16 
PHI  ■  0.608781E-02 
THETA  a  -.160134E-14 
PSX  a  0.X53802E-02 
Z  a  0.202062E-01 
OS  a  O.OOOOOOE+OO 
OB  ■  O.OOOOOOE+OO 


Miimiii 


9.00000C«M 

O.OOOOOHOO 

O.DMW«H 


Table  C.2:  Twenty  Knot  Linear  Syeten:  A,  B  end  C  Matrices 


A  MATRIX 


-oi  -.soioot-i*  ■.uim-u  -.utm-u  i.umh-m  i.umi-u  i.mimn  o.twui-is  0.000001*00  o.ooooot*oo 
-t*  -.huu-u  i.itoa-u  ».miu«a  i.mw-u  -.110771*02  o.uioihoo  i.inus-a  o.ooooonoo  o.ooooot«oo 

■H  -.411171-19  '.MMI-U  -.miw-14  •.97IMI4U  -.  149001-10  0.000001 1 09  0.7*1701-02  0.000001 1 00  0.000002*00 
-OS  -.7977W-02  -.114071-11  -.29*441 1 00  -.2902*1-1*  -.109*01-01  -.U21U*O0  -.401071-21  0.000001 1 00  O.OOOOOHOO 
-0*  0.49S07I-21  0.10S2M-02  -.209901-1*  -.2* 7401 *00  -.212291-19  0.000001 1 00  -.2S12SK-02  0.900002*00  0.000001*00 
-0*  -.1*0011-01  -.4441SC-21  -.40*121-02  -.7747*0-19  -.IS 9001 *00  0.2*1001-02  0.7770*1-24  0.000001*00  0.000001*00 
•00  0.000001*00  0.000000*00  0.100001*01  -.29*721-20  -.2792K-1*  0.412022-29  -.144001- U  0.000001 *00  0.000001*00 
•00  O.OOOOOHOO  0.000001*00  0.000000*00  0.100001*01  -.10*2*1-01  0.244001-1*  O.OOOOOHOO  0.400000*00  0.000001*00 
•00  O.OOOOOHOO  0.000001 1 00  O.OOOOOHOO  0.10*2*1-01  0.100001*01  -.140001-22  0.9*0*21-22  0.000001*00  0.000001*00 
-1*  0.10*2*1 -OS  0.100000*01  0.000001*00  0.000001*00  0.000001*00  0.074001-14  -.222201*02  0.000001*00  0.000001*00 


•  MATRIX 


0.2*0141-02 
0.000001 *00  0 
-.914071*00  - 
0.000001*00  0 
-.221101-01  0 
O.OOOOOHOO  0 
0.000001*00  0 
O.OOOOOHOO  0 
0.000001 1 00  0 
O.OOOOOHOO  0 


•00  0, 
•00  0. 
♦00  0 
•02  0. 
[«O0  - 
•00  0. 
1*00  0. 
1*00  0, 
;*00  0. 


190241-01 


2710*1-01 


C  MATRIX 


1.000001*00  0.0 

I.OOOOOHOO  0.0 


1*00  O.OOOOOHOO 

0*00  0.0 


0.000001*00  0.000001*00  0.100001 *01  0.000001 *00  0.000001*00 
0.000001*00  0.000001*00  0.000001*00  0.100001*01  0.000000*00 
0.100000*01  0.000001*00  O.OOOOOHOO  0.000001*00  0. 000001*00 


Table  C.3:  Twenty  Knot  Augaantad  Linear  Systan:  A,  B,  and  C  Hatrlci 


a  mm 

•.tn-ii  -oMi-i*  -  uti-«s  -.nn-u  o.uoc-u  o.oo mw 

-.moo-os  -.4911-41  o.imo-io  4.1*70-1*  -.11*941  i.ua«n 

-.*4M-4*  -.4UI-19  -.4400-91  -.MM-M  4.4711941  -.1700-14  I.HWHI 
•.177141  •.7«4t  -.SIM -11  -.mem  -.1900-1*  -.1MC41  -.UM944 
I.UK-N  9.4940-11  t.im-tt  -.1101-14  -.1*70449  -.llM-19  O.Mt  H> 
-.4090-44  -.10*0-41  -.4440-11  -.4400-41  -.7710-19  <.ISO«M  0.C4CS-0S 
•.0000940  0.0000940  9.0000 1 10  4.1000941  -.C970-C4  -.1790-1*  0.4140-19 
4.0400940  0.0000940  0.4000944  4.4400944  0.1401941  -.1440*41  0.1440-1* 
0.0000944  4.4400944  4.0400944  4.4400944  4.14*0-41  4.1400941  -.1440-tt 
0.1790-1*  0.14*0-41  4.1400941  4.4400944  0.4400944  4.0400944  4.S74C-14 


1.1900*41  4 
>.1910-11  4 
>.  70M-41  4 
.4411-11  4 
.me -41  4 
1.7770-14  4 

.1440-1*  4 
>.4000104  4 

>.9*10-11  4 
.SH094t  4 


1440< 


m  1 1  m  i  m 


Table  C.4:  Twenty  Knot  Coapanaator  Gaina:  G  and  H  Hatrli 


•  mrwtx 

.1M*M  l.4IU*ft  -.lit  ft  *971*04  O.S01f*00  MM«  tt  *.Zia»M  -  JMC-Ot  O.lOOEaOt  0.tlU«Ot  -.30K-01 

.ooa-o*  -.uoi-oi  -.1191-01  0.1191-01  o.im+oe  -.ioot*ot  -.smi-oi  -.joot-o*  o.*ui*oi 


n  mrax 


114C-17 

4701-1* 

o.izst-ij 

IM-ll 

-.Ult-21 

0.7191-19 

tMZ*M 

-.1091-10 

im«u 

-.9011-10 

mi -u 

-.SSSt-17 

tSlf-19 

0.f49t-lO 

loottoo 

-.MI-11 

M(*14 

0. loot 4«e 

w*f-ti 

-.1401-11 

rnc-u 

0. 7911-19 

imssin 


APPENDIX  D 


I 


Tabl#  D.i:  T«  Knot  Augnantod  Linear  Syatan:  A,  B  and  C  Hatri 


a  mmx 


.lsu-n  i.mi-u  -.tiM-i*  i.niMt  o.m-oi  -.tmi-io  «.mk*n  •. 

.1M4S  '.MU-41  -.171-14  -.SW-U  -.HUMl  |.1UI«M  0.4701-10  I. 

.SS3K*M  -.111-11  '.tftC-41  9.3741-10  I.44SM1  9.3031-11  9.1999199  0.74MHI  I. 

93  -.4041-0 *  0.4O3I-U  -.100t»00  0.40CI-lt  -.9411-1  -.lUf«00  -.021-14  0. 

•4  -.7771-10  0.1041 -OS  0.4HC-10  -.13110  l.ltM-U  9.991 1 00  -.OSlC-Ot  0. 

00  -.931-03  0.9711-10  -.OSlC-Ot  0.11U-U  -.1*11 *00  0.*0tt -03  0.1041-10  0. 

oo  o.ooi ioo  room  o.ioin  -.0111-10  o.uot-u  -.wc-cs  t.n-12  0. 

00  0. 00110  0.00110  0.00110  0.10111  0.001-1  -.401-12  I.0M1  0. 

I  0.00110  0.00110  0.00110  -.301-03  0.1WH  -.091-10  0.001-24  0. 

II  -.00110  9. 101H  0.00110  0.00110  0.00110  -.071-10  -  Wilt  0. 


n  i  si  m  1 1 


Table  D.2:  Tan  Knot  Syston  Eigenvalues  and  Trananiaaion  Zaroa 


POLES 


HMa  SEAL  1HM  0  AMPINS 

X  0.0000000006*00 

2  O.OOOOOOOOOE+OO 

3  -S . 828 7 1341 6E -03 

4  -1.3111 78 789€-0 2 

6  -1 . 329846220E-02  1.8124634656-02  5. 915679721E-01 

7  -1.000000000E-01 

a  -l. ooooooooo e -oi 

9  -1.3829638776-01 

10  -1.646311070E-01 

12  -7 . 2972089776-02  3.9327873256-01  1.8243416546-01 


ZEROES 


tttSEB  BEAL  BUS  PAMPINS 

1  -1.3111786956-02 

2  -7.5235059466-02 

3  -8.3826817416-02 

4  2.4120656196-01 

6  -7.3125442796-02  -3.9201590086-01  1.833738696E-01 


FREQUENCY 


2.2480023986-02 


3 . 999913591E-01 


FREWENCY 


3 . 967778791E-01 
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Table  D.3:  Tan  Knot  Coapenaator  Galna:  G  and  K  Hatrlcaa 


.4 >101-01 
.1441-04 


0.140*05  -.UK -01 
0.5441*00  0.1411*00  0. SMC -01 


-. OS 11 *04  -.130*01 
-.7171*01  -.4451*01 


-.S1K-02  -.5111*04  0.  UK-01  0.1731*01  0.1511*01 
-.1MK-01  -.1441*01  -. 1751*01  O.llSC-Ol  0.440C-01 


H  HATUX 


o.sm-14  -.uoc-is 

-.4441-14  -.44H-14 
-.4151-10  0.5141-10 
0.1401 -IS  -.4401-10 
-.1451-10  0.5400-10 
0.170-14  0.1441-10 
0.7151-11  -.540-17 
0.1001-10  -.1471-14 
0.1001*00  -.4041-14 
O.im-U  0.1000*00 
-.0001-10  0.1441-14 
0.1401-17  -.4701 -14 


1.4401-01 

1.5151*01 
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APPENDIX  E 


Tibia  E.l:  FI vi  Knot  Augmented  Linear  Syatan: 


A,  B  and  C  Hatricaa 


-.tuc-oc  -.cost-is  -.luf-M  -.itm-is  i.na<«t 

'.iUI-M  -.tUf-fl  O.WM-17  -,2S7C«M  0.077* -14  -.JOS*  *01 
-.MW  •«  -.USC-14  -.17** -01  -.1711-11  0.CS1S*01  0.1*4* -IS 
•  .10H -OS  -.*111-0*  0.4111 -CO  -.TOM -01  -.1001 -IS  -.S01C-0* 
0.S4M-07  0,1071-10  0.  COM -OS  -.  107C-1S  -.7071-01  -.110* -17 
-.10*1-00  -.OSSi-OS  0.1041-10  -.1*11-0*  0.7CM-17  -.OS *1-01 
0.0000*00  0.0000*00  0.0000*00  0.1000*01  0.1 Wt -10  -.010* -IS 
0.0000 ■  00  0.0000 1 00  0.0000*00  0.0000*00  0.1000*01  O.IOM-OS 
0.0000*00  0.0001*00  0.0000 1 00  0.0001*00  -.104* -OS  0.1001*01 
0.4141-1S  -.144* -OS  0.1000*01  0.0001*00  0.0001*00  0.0001*00 
0.0001*00  0.0001*00  0.0001*00  0.0001*00  0.9001*00  0.0001*00 
0.0001*00  0.0001*00  0.0001*00  0.0001*00  0.0001*00  0.0001*00 


0.0001*00  0.  CMC -OS  0.0001*00  0.0001*00  0.1S11-OS  0.0001*00 
0.1SCf*00  -.1101-10  0.0001*00  0.0000*00  0.0001*00  0.7041-01 
0.9000*00  0.74(1-02  0.0001*00  0.0000*00  -.4S41-01  0.0001*00 
-.1411*00  0. 1440-14  0.0000*00  0.0001*00  0.0001*00  0.1SM-OC 
0.0001*00  -.csil-ot  0.0001*00  0.0001*00  -.114! -Ot  0.000**00 
0.1421 -OS  -.S1S1-22  0. 000* *00  0.0001*00  0. 0001*00  -.104* -01 
-.SSS1-SS  -.1171 -IS  0.0001*00  0.0001*00  0.000* *00  0.0001*00 
0.1 171 -is  0.0001*00  0.0001*00  0.0001*00  0.0001*00  0.0001*00 
0.04R-M  0.7111-14  0.0001*00  0.000**00  0.0001*00  0.0001*00 
0.1401-11  -.0011*01  0.0001*00  0.0001*00  0.0001*00  0.0001*00 
0.0001*00  0.000**00  0.000* *00  0.0001*00  -.1001*00  0.0001*00 
0.0001*00  0.000**00  0.0001*00  0.0001*00  0.0001*00  -.1001*00 


■  mntxx 

0.0001*00  0.0001*00 


0.0001*00  0.1001*00 


0.000l< 

0.1 


1*00  0.0000*00  0. 

1*00  0.0001*00  0. 


0.0001*00  0.0001*4 
0.0001*00  0.0001*4 


\  0.0001*00  0. 
i  0.0001*00  o, 


♦00  0.1001*01  0.0001*00  0.0001*00  0. 
0.0001 *00  0.1001*01  0.0001*00  0. 
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Tabla  E.2:  Fiva  Knot  Syataa  Eiganvaluaa  and  Tranaaiaaion  Zaroa 


POLES 


M*»ER  BEAU 


ISAS  DAMPING  FBEWENBC 


1  O.OOOOOOOOOE+OO 

2  O.OOOOOOOOOE+OO 

3  -3.024089983E-03 

4  -7.113993141E-03 

5  -3.005U7302E-02 

7  -2 . 892676692E -02  2. 30862074 7E-02  7.815959177E-01  3 . 700987462E-02 

8  -8.558510799E-02 

9  -I.OOOOOOOOOE-Ol 

10  -1.000000000E-01 

12  -3 . 82541510 IE -02  4.00101748SE-01  9.517701732E-02  4. 019263483E-01 


ZEROES 


NUMBER  REAL 


IMAG  DAMPING  FRESLffitgX 


1 

2 

3 

4 
6 


-7.U3992856E-03 
-2.890585762E-02 
-4 . 318266216E  *02 
1.153794658E-01 
-3.845341422E-02 


-3 . 996021859E-01 


9.578676498E-02 


4. 014480939E-01 


Tabla  E.3:  Fiva  Knot  Coapansator  Gains:  G  and  H  Hatricas 


ittwt 
633* -OS 


6  HA  TWIX 

■.nic -oi  o.iMe^os  -.me -oi  -.ttocmh  -.1472401  -.izoe-oi  -.me*o*  0.0226-02  o. iooe»oz  0.7536*01  o.zooe-ot 
i.tsoe+oo  o.ioie*oo  o.i*n+oo  -.sou*oi  -.noe*os  o.sioc-oz  -.io4e*oi  -.ioo€*oe  0.0226-02  0.2042-02  0.1422*01 


H  MATWIX 

-.4406-17  0.4551 -IS 
-•1041-14  0.1 41* -15 
-.2 41* -16  -.3421-17 
0.44Sf-17  -.2466-17 
-.861E-20  -.4246-15 
0.3786-17  -.1036-17 
-.4446-14  0.1576-17 
-.2676-16  -.1546-17 
0. 1006*00  -.1206-14 
0.2SS6-14  0. 1006*00 
0.0006MM  0.0006MM 
0.0006400  0.0006400 
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